|
|
想做個小車
是用舵機轉向
在網上查了不少舵機的資料
可以改變PWM固定的調整舵機轉向
但是這樣每次寫，燒錄，記錄角度的效率太低了
所以用Uart通信來改變PWM的值
但是遇到個問題
程序運行
在電腦輸入一次數值可以有效調節一次舵機
然后在串口調試助手再次輸入數據就無效了
請大神們多多指導，感激不盡！
- #include<reg52.h>
- sbit Motor=P1^4;
- unsigned char Rxddata[4];
- unsigned int a,c;
- bit cmdArrived = 0;
- unsigned char *buf;
- void ConfigUART(unsigned int baud);
- unsigned int StrToInt(unsigned char *str);
- void main()
- {
- EA = 1;
- ConfigUART(9600);
- ET0 = 1;
- TF0 = 0;
- TR0 = 1;
- TMOD &= 0xF0; /*設初值*/
- TMOD |= 0x01;
- Motor=1;
- a=1500; /*數值 1500 即對應 1.5ms，為舵機的中間 90 度的位置*/
- c=a;
- TH0=-(a/256);
- TL0=-(a%256); /*設定定時器初始計數值*/
- buf = Rxddata;
- while(1)
- {
-
- if(cmdArrived)
- {
- cmdArrived = 0;
- a = StrToInt(Rxddata);
- }
- }
- }
- unsigned int StrToInt(unsigned char *str) //接收到的數據轉為int格式
- {
- unsigned int temp = 0;
- while(*str!= 0)
- {
- if((*str < '0') || (*str > '9'))
- {
- break;
- }
- temp = temp *10 +(*str - '0');
- str++;
- }
- return temp;
- }
- void InterrupPWM() interrupt 1
- {
- Motor=~Motor; /*輸出取反*/
- c=20000-c; /*20000 代表 20 ms，為一個周期的時間*/
- TH0=-(c/256);
- TL0=-(c%256); /*重新定義計數初值*/
- if(c>=500&&c<=2500)
- c=a;
- else
- c = 20000-a; /*判斷脈寬是否在正常范圍之內*/
- }
-
- void ConfigUART(unsigned int baud) //設置波特率
- {
- SCON = 0x50;
- TMOD &= 0x0F;
- TMOD |= 0x20;
- TH1 = 256 - (11059200/12/32)/baud;
- TL1 = TH1;
- ES = 1;
- TR1 = 1;
- ET1 = 0;
- }
- void InterruptUART() interrupt 4
- {
-
- if(RI)
- {
- RI = 0;
- cmdArrived = 1;
- *buf = SBUF;
- SBUF = *buf++;
- }
- if(TI)
- {
- TI = 0;
- }
- }
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
