基于stm32f1的讀取博創串口控制電機的協議,通過讀取博創控制卡串口發送的數據轉成PWM來控制電機
單片機源程序如下:
- /************************GUO NING*******************
- 文件名:main.c
- 維護人:
- 維護日期:
- 描述:主函數程序,執行接收到的命令
- ****************************************************/
- #include "stm32f0xx.h"
- #include "userdef.h"
- #include "led.h"
- #include "motor.h"
- #include "cds5500_slave.h"
- #include "delay.h"
- //#include <stdio.h>
- u16 speed_A=0,speed_B=0;
- int main(){
- Delay_Init(48);
- LED_Init();
- // LED_ON;
- // delay_ms(500);
- motor_conf();
- CDS_Init();
- // printf("STM32F030F4P6 USART TEST\r\n");
- // LED_OFF;
- // delay_ms(500);
- while(1){
- // printf("%d ok\r\n",CDS5500_data[0].buf[2]);
- // printf("%d ok\r\n",CDS5500_data[0].buf[11]);
- // printf("CDSFrames_D=%d\r\n",CDSFrames_D);
- // printf("CDSFrames_R=%d\r\n",CDSFrames_R);
- if(CDSFrames_D!=CDSFrames_R){
- u8 len,i,csum=0;
- LED_ON;
- len=CDS5500_data[CDSFrames_D].buf[3];
- for(i=0;i<len+1;i++)
- {
- csum+=CDS5500_data[CDSFrames_D].buf[2+i];
- }
- // printf("%d\r\n",((u8)(~csum)));
- // printf("%d ok\r\n",CDS5500_data[CDSFrames_D].buf[len+3]);
- // printf("CDS5500_data[0]=");
- // for(i=0;i<20;i++)
- // printf(" %02X",CDS5500_data[0].buf[i]);
- // printf("\r\n");
- // printf("CDS5500_data[1]=");
- // for(i=0;i<20;i++)
- // printf(" %02X",CDS5500_data[1].buf[i]);
- // printf("\r\n");
- printf("CDS5500_data[3]=");
- for(i=0;i<20;i++)
- printf(" %02X",CDS5500_data[CDSFrames_D].buf[i]);
- printf("\r\n\r\n");
- // printf(" %02X",CDS5500_data[CDSFrames_D].buf[len+3]);
- // printf("\r\n");
- // printf(" %02X",(u8)(~csum));
- // printf("\r\n");
- if(CDS5500_data[CDSFrames_D].buf[len+3]==(u8)(~csum)){
-
- if(CDS5500_data[CDSFrames_D].buf[2]==ID_A){
- if((CDS5500_data[CDSFrames_D].buf[4]==CMD_WRITE)&&(CDS5500_data[CDSFrames_D].buf[5]==0X20)){
- speed_A=CDS5500_data[CDSFrames_D].buf[7]&0X03;
- speed_A<<=8;
- speed_A|=CDS5500_data[CDSFrames_D].buf[6];
- if(speed_A==0){ //制動
- GPIO_ResetBits(GPIOA,GPIO_Pin_2);
- GPIO_ResetBits(GPIOA,GPIO_Pin_3);
- }
- else if((CDS5500_data[CDSFrames_D].buf[7]&0X04)==0){ //前進
- GPIO_SetBits(GPIOA,GPIO_Pin_2);
- GPIO_ResetBits(GPIOA,GPIO_Pin_3);
- }
- else{ //后退
- GPIO_ResetBits(GPIOA,GPIO_Pin_2);
- GPIO_SetBits(GPIOA,GPIO_Pin_3);
-
- }
- if(speed_A>1000) speed_A=1000;
- TIM_SetCompare1(TIM3,speed_A);
- TIM3->CNT=0;
- }
- }
- if(++CDSFrames_D>=MAX_FRAME_NUM) CDSFrames_D=0;
- }
- for(i=0;i<6;i++)
- {
- csum+=CDS5500_data[CDSFrames_D].buf[11+i];
- }
- if(CDS5500_data[CDSFrames_D].buf[17]==(u8)(~csum)){
- if(CDS5500_data[CDSFrames_D].buf[11]==ID_B){
- if((CDS5500_data[CDSFrames_D].buf[13]==CMD_WRITE)&&(CDS5500_data[CDSFrames_D].buf[14]==0X20)){
- speed_B=CDS5500_data[CDSFrames_D].buf[16]&0X03;
- speed_B<<=8;
- speed_B|=CDS5500_data[CDSFrames_D].buf[15];
- if(speed_B==0){ //制動
- GPIO_ResetBits(GPIOA,GPIO_Pin_4);
- GPIO_ResetBits(GPIOA,GPIO_Pin_5);
- }
- else if((CDS5500_data[CDSFrames_D].buf[16]&0X04)==0){ //前進
- GPIO_SetBits(GPIOA,GPIO_Pin_4);
- GPIO_ResetBits(GPIOA,GPIO_Pin_5);
- }
- else{ //后退
- GPIO_ResetBits(GPIOA,GPIO_Pin_4);
- GPIO_SetBits(GPIOA,GPIO_Pin_5);
-
- }
- if(speed_B>1000) speed_A=1000;
- TIM_SetCompare2(TIM3,speed_B);
- TIM3->CNT=0;
- }
- }
- if(++CDSFrames_D>=MAX_FRAME_NUM) CDSFrames_D=0;
- }
-
-
- }
- else LED_OFF;
- }
- }
復制代碼
所有資料51hei提供下載:
博創CDs5500協議.rar
(611.52 KB, 下載次數: 10)
2018-8-25 16:53 上傳
點擊文件名下載附件
|