7260fe9fba
根因:imu_init(200) 声明200Hz,但imu_update实际在50Hz任务中调用, Mahony积分dt差4倍,导致转90度只测出22度。 修复:imu_update移至10ms任务(100Hz),传感器采集与控制频率对齐。 同时将任务周期全部参数化: - Task.h 统一定义 TASK_10MS/20MS/50MS_FREQ_HZ - 各子系统init改为传入频率(Hz),内部算周期(dt) - PIT定时器周期由存储的dt自动计算,消除硬编码
建议用户需要添加自己的代码文件的时候,将文件存放在CODE文件夹下 不要再创建子文件夹,直接将代码文件放在CODE文件夹里面就行 然后工程里面添加文件即可编译