智能车制作

 找回密码
 注册

扫一扫,访问微社区

查看: 1652|回复: 8
打印 上一主题 下一主题

跪求一个答案

[复制链接]

1

主题

1

帖子

0

精华

注册会员

Rank: 2

积分
105
威望
57
贡献
34
兑换币
36
注册时间
2018-8-9
在线时间
7 小时
跳转到指定楼层
1#
发表于 2018-8-17 16:10:20 | 显示全部楼层 回帖奖励 |倒序浏览 |阅读模式
直立车,不用printf就会死        while(1)
        {
                if(flag==4)
                {
                        MPU6050ReadAcc(Accel);
                        MPU6050ReadGyro(Gyro);
                        acceleration0=acosf(((double)Accel[2])/15788.0)*57.3;
                        acceleration1=(double)Accel[0]/(double)15788*165.6/3.1415+11;
                       
                       
                        if(acceleration1<45.0)acceleration2=acceleration1;
                        else        acceleration2=acceleration0;
               
                        angular_acceleration=angular-((double)Gyro[1]*2000.0/32763.0*0.005);
                        angular=acceleration2*0.05+angular_acceleration*0.95;
       
                       
                       
                        rIn = angular;                //  Read Input
                        rOut = PIDCalc ( &sPID,rIn );   //  Perform PID Interation
                                                                 ;
               
                        if(rOut>0)
                        {
                                if(rOut>6400)rOut=6400;
                                left_b=0;
                                left_a=450+(int16_t)rOut;
                                right_b=500+(int16_t)rOut;
                                right_a=0;
                        }
                        else
                        {
                                if(rOut<-6400)rOut=-6400;
                                left_a=0;
                                left_b=450-(int16_t)rOut;
                                right_a=500-(int16_t)rOut;
                                right_b=0;
                        }
                        printf("\r\n");
                        TIM3_Mode_Config(left_a,left_b,right_a,right_b);       
                        flag=0;
                }

回复

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则

关于我们|联系我们|小黑屋|亿加合和智能车制作 ( 黑ICP备2022002344号

GMT+8, 2024-5-7 17:05 , Processed in 0.076280 second(s), 25 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回复 返回顶部 返回列表