双向双路电调双流差速算法

最新推荐文章于 2025-02-13 15:11:52 发布

原创最新推荐文章于 2025-02-13 15:11:52 发布 · 566 阅读

10 ·

CC 4.0 BY-SA版权

文章标签：

#算法 #java #前端

这个很简单，就是直接使用油门+转向混合就好，超限的截掉，算法如下

     
                int esc1 =  thr-1500;   ///range -500->500
                int esc2 = esc1;      
                int diff = turn -1500;
                bool isTurnActive = (diff<-50 || diff > 50 );
                bool isThrActive  = (esc1 >50 || esc1 <-50);

                if(isThrActive|| isTurnActive )
                {
                    
                    esc2 = esc1 -diff;
                    esc1 = esc1 + diff;

                    LIMIT_TO(esc1,500,-500); ///range -500->500
                    LIMIT_TO(esc2,500,-500); ///range -500->500
   
                }
                else 
                {
                    esc1  = 0;
                    esc2  = 0;
                }