烽火社区

标题: 【飞思卡尔MAPS四色板开发套件】控制小车代码 [打印本页]

---

作者: dcjiang    时间: 2016-6-21 08:09 AM
标题: 【飞思卡尔MAPS四色板开发套件】控制小车代码


this HTML class. Value is SpeedKP =2.5;   


上次控制小车的帖子没找到，再开一帖放代码

如果代码在网页状态下没有正常显示，附件也有个代码文件可以查看

1. ~}SpeedKP =2.5;              //*~{KY6H~}P  ~{9}4s#,35BVP}W*R;G0W*R;:sW*#,1mOVN*W_W_M#M#~}
   
2.         SpeedKI_big=0.15;        //~{4s5DKY6H~}I~{#;P!5DN*9L6(V5#;~}
   
3.         SpeedKD =0.38;          //*~{KY6H~}D
   
4.         
   
5.         left_canshu=0;       //~{M<Oq4&@m2NJ}~}
   
6.         right_canshu=0;
   
7.         TurnMidPosition=75;
   
8.         
   
9.         if((valuerownum<20)&&(absx(CenterEq)<30))
   
10.         {
    
11.           TurnP=15,TurnD=20;
    
12.           if((valuerownum<8)&&(absx(CenterEq)<4))
    
13.           {
    
14.            g_Speedgoal=1700;
    
15.           }
    
16.           else
    
17.           {
    
18.           g_Speedgoal=1700;
    
19.           }
    
20.         }      
    
21.         else
    
22.         {
    
23.           g_Speedgoal=1700;
    
24.           if(CenterEq>0)//~{SRMd~}35.7777777
    
25.           {
    
26.           TurnP=(1/45)*CenterEq*CenterEq+45.5;//13.2
    
27.           TurnD=50;
    
28.           }
    
29.           else //~{WsMd~}32.7777777
    
30.           {
    
31.           TurnP=(1/45)*CenterEq*CenterEq+45.5;
    
32.           TurnD=50;         
    
33.           }
    
34.         }  

复制代码

---

作者: gronau    时间: 2016-6-21 10:36 AM
楼主可以把代码贴在帖子里，还有就是楼主的代码是不是少了点东西，？

---

欢迎光临 烽火社区 (https://bbs.cnecport.com/)

Powered by Discuz! X3.2