久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: 2輪平衡小車stm32源碼 [打印本頁]
作者: 飛雨額    時間: 2018-5-13 14:39
標題: 2輪平衡小車stm32源碼
我自己做過的，可以用單片機源程序如下:
  1. #include"stm32f10x.h"
  2. #include"delay.h"
  3. #include"usart.h"
  4. #include"sys.h"
  5. #include"encoder.h"
  6. #include"pwm.h"
  7. #include"mpu6050.h"
  8. #include"inv_mpu.h"
  9. #include"usart2.h"
  10. #include"oled.h"
  11. #include"ascii.h"
  12. #include"pid.h"
  13. int main()
  14. {
  15.         u8 oled_flag=0;//oled相關
  16.         u8 temp;
  17.        
  18.         delay_init();
  19.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
  20.         uart_init(115200);//usart
  21.         Usart2_Init(9600);
  22.        
  23.        
  24.   
  25.         ENCODER_Init();
  26.         I2C2_Init();//oled
  27.        
  28.         Pwm_Init(7200,0);//moter
  29.         MPU_Init();
  30.         while(mpu_dmp_init());
  31.         A8_Motor_STNBY();
  32.         TIM1_Int(5000,71);
  33.         OLED_Init();
  34.         OLED_Clear();
  35.         OLED_ShowHanZi(0,0,1);
  36.         OLED_ShowHanZi(16,0,2);
  37.         OLED_ShowChar(32,0,':',16);
  38.   OLED_ShowChar(56,0,'%',16);

  40.   OLED_ShowHanZi(64,0,1);
  41.         OLED_ShowHanZi(80,0,2);
  42.         OLED_ShowChar(96,0,':',16);
  43.   OLED_ShowChar(120,0,'%',16);
  44.   OLED_ShowString(0,2,"ROLL:",16);
  45.         OLED_ShowString(0,6,"L:",16);
  46.         OLED_ShowString(64,6,"R:",16);
  47.        
  48.         OLED_ShowString(0,4,"H:",16);
  49.         OLED_ShowString(64,4,"us",16);
  50.         OLED_ShowChar(88,4,'G',16);
  51.         OLED_ShowString(88,2,"SMD:",16);
  52.         while(1)
  53.         {
  54.                
  55.                
  56.                
  57.                
  58.                
  59.                         Decide();
  60.                 if(oled_flag%5==0)//防止OLED占用過長時間
  61.                 {
  62.                             OLED_ShowChar(96,4,sr04_gate_val/1000%10+'0',16);
  63.                             OLED_ShowChar(104,4,sr04_gate_val/100%10+'0',16);
  64.                             OLED_ShowChar(112,4,sr04_gate_val/10%10+'0',16);
  65.                             OLED_ShowChar(120,4,sr04_gate_val%10+'0',16);
  66.                                         if(Motor_A>=0)
  67.                                         {
  68.                                                 if(Motor_A>7199)Motor_A=7199;
  69.                                                 OLED_ShowChar(104,0,(u32)Motor_A*100/7200/10%10+'0',16);//電機a和b的pwm顯示
  70.                                                 OLED_ShowChar(112,0,(u32)Motor_A*100/7200%10+'0',16);
  71.                                         }else
  72.                                         {
  73.                                                 if(Motor_A<-7199)Motor_A=-7199;
  74.                                                 OLED_ShowChar(104,0,(u32)(-Motor_A)*100/7200/10%10+'0',16);//電機a和b的pwm顯示
  75.                                                 OLED_ShowChar(112,0,(u32)(-Motor_A)*100/7200%10+'0',16);
  76.                                         }
  77.                                         if(Motor_B>=0)
  78.                                         {
  79.                                                 if(Motor_B>7199)Motor_B=7199;
  80.                                                         OLED_ShowChar(40,0,(u32)Motor_B*100/7200/10%10+'0',16);
  81.                                                         OLED_ShowChar(48,0,(u32)Motor_B*100/7200%10+'0',16);
  82.                                         }else
  83.                                         {
  84.                                                 if(Motor_B<-7199)Motor_B=-7199;
  85.                                                 OLED_ShowChar(40,0,(u32)(-Motor_B)*100/7200/10%10+'0',16);
  86.                                           OLED_ShowChar(48,0,(u32)(-Motor_B)*100/7200%10+'0',16);
  87.                                         }
  88.                                         if(roll<0)
  89.                                         {
  90.                                                  OLED_ShowChar(40,2,'-',16);
  91.                                                  temp=-roll; //盡量不要修改roll值，會對pwm造成影響
  92.                                         }
  93.                                         else
  94.                                         {
  95.                                                 temp=roll;
  96.                                                 OLED_ShowChar(40,2,'+',16);
  97.                                         }                                               
  98.                                         OLED_ShowChar(48,2,(u8)temp/10+'0',16);
  99.                                         OLED_ShowChar(56,2,(u8)temp%10+'0',16);
  100.                                         OLED_ShowHanZi(64,2,3);
  101.                                         if(Encode_left<0)
  102.                                         {
  103.                                           OLED_ShowChar(16,6,'-',16);
  104.                                                 OLED_ShowChar(24,6,(-Encode_left)/100%10+'0',16);
  105.                                                 OLED_ShowChar(32,6,(-Encode_left)/10%10+'0',16);
  106.                                                 OLED_ShowChar(40,6,(-Encode_left)%10+'0',16);
  107.                                         }else
  108.                                         {
  109.                                           OLED_ShowChar(16,6,'+',16);
  110.                                                 OLED_ShowChar(24,6,(Encode_left)/100%10+'0',16);
  111.                                                 OLED_ShowChar(32,6,(Encode_left)/10%10+'0',16);
  112.                                                 OLED_ShowChar(40,6,(Encode_left)%10+'0',16);
  113.                                         }
  114.                                         if(Encode_right<0)
  115.                                         {
  116.                                           OLED_ShowChar(80,6,'-',16);
  117.                                                 OLED_ShowChar(88,6,(-Encode_right)/100%10+'0',16);
  118.                                                 OLED_ShowChar(96,6,(-Encode_right)/10%10+'0',16);
  119.                                                 OLED_ShowChar(104,6,(-Encode_right)%10+'0',16);
  120.                                         }else
  121.                                         {
  122.                                           OLED_ShowChar(80,6,'+',16);
  123.                                                 OLED_ShowChar(88,6,(Encode_right)/100%10+'0',16);
  124.                                                 OLED_ShowChar(96,6,(Encode_right)/10%10+'0',16);
  125.                                                 OLED_ShowChar(104,6,(Encode_right)%10+'0',16);
  126.                                         }
  127.                                        
  128.                        
  129.                                         if(oled_flag==5)oled_flag=0;
  130.                                        
  131.                 }
  132.                 oled_flag++;
  133.        
  134.         }   

  136. }
復制代碼

所有資料51hei提供下載:
平衡小車工程.rar (362.65 KB, 下載次數: 10)






歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 久久久久国产精品www | 懂色中文一区二区三区在线视频 | 国产一区二区 | 日本黄色高清视频 | 免费毛片网 | 精品国产区 | 久久精品99国产精品 | 久久久久国产精品人 | 日韩视频中文字幕 | 爱爱爱av | 国产成人精品免高潮在线观看 | 免费黄色片视频 | 91国产精品 | 特黄特色大片免费视频观看 | 国产日韩精品一区二区 | 97视频久久 | 一区二区中文字幕 | 成在线人视频免费视频 | 在线观看h视频 | 亚洲一区二区三区免费 | 四虎在线观看 | h视频在线观看免费 | 国产一区二区三区在线 | 欧美激情啪啪 | 久久久蜜臀国产一区二区 | 在线a视频网站 | 久久久成人精品 | 中文字幕人成人 | 日韩在线观看网站 | 国产区精品 | 欧美精品片 | 看av电影 | 国产一在线观看 | 请别相信他免费喜剧电影在线观看 | 久久亚洲天堂 | 欧美一级黄色片免费观看 | 在线日韩 | 国产精品a免费一区久久电影 | 国产精品av久久久久久毛片 | 亚洲欧美视频一区 | 亚洲一区国产 |