单片机源程序如下:
- #include "main.h"
- uint32_t Upload_Speed = 1; //数据上传速度 单位 Hz
- #define upload_time (1000000/Upload_Speed) //计算上传的时间。单位为us
- uint16_t power1=0,power2=0;
- uint32_t system_micrsecond; //系统时间 单位ms
- int main(void)
- {
- ControtLoopTaskInit(); //app init
- RemoteTaskInit();
- delay_ms(800);
- BSP_Init();
- system_micrsecond = Get_Time_Micros();
- while(1)
- {
- IMU_getYawPitchRoll(angle);
- if((Get_Time_Micros() - system_micrsecond) > upload_time)
- {
- system_micrsecond = Get_Time_Micros();
- UploadParameter(); //upload data to the PC
- delay_ms(1);
- }
- }
- }
复制代码
所有资料51hei提供下载:
RM2016_INFANTRY_OPEN_SOURCEV.1.6.4.rar
(664.43 KB, 下载次数: 15)
|