#include "zf_common_headfile.h" #include "pinconfig.h" // 宏定义引脚配置 #include "device.h" #include "motor.h" #include "motion_control.h" // 打开新的工程或者工程移动了位置务必执行以下操作 // 第一步关闭上面所有打开的文件 // 第二步 project->clean 等待下方进度条走完 // 本例程是开源库移植用空工程 extern float car_yaw; uint8 data_buffer[32]; uint8 data_len; int main(void) { clock_init(SYSTEM_CLOCK_600M); // 不可删除 debug_init(); // 调试端口初始化 system_delay_ms(300); // 设备初始化 Device_Init(); while(1) { // printf("Hello\r\n"); // memset(data_buffer, 0, 32); // sprintf((char *)data_buffer,"%f\r\n",arhs_data.yaw); // wireless_uart_send_buffer(data_buffer, strlen((const char *)data_buffer)); // 检查车身姿态 printf("%f\r\n",xCarParam.yaw); // 检查编码器输出值 // printf("%d,%d,%d,%d\r\n",encoder_data_quaddec[0], // encoder_data_quaddec[1], // encoder_data_quaddec[2], // encoder_data_quaddec[3]); // 磁场矫正代码 // imu963ra_get_mag(); // printf("%d,%d,%d\r\n",(int16)(0.9599961588556194*(imu963ra_mag_x+9.0690548656859)), // (int16)(0.9699354085002723*(imu963ra_mag_y+391.0095353186761)), // (int16)(1.0783616544950039*(imu963ra_mag_z-197.76663552701817)) // ); // vofa IMU // printf("%f,%f,%f\r\n",arhs_data.pitch,arhs_data.roll,arhs_data.yaw); system_delay_ms(1000); } }