我的四轴单片机源程序如下:
- #include "public.h"
- int Init(void)
- {
- SYSTEM_SetClock(72); //初始化系统时钟为72MHZ
- uart_init(72,9600); //初始化串口为9600
- IIC_Config(); //初始化IIC总线
-
- TIM4_PWM_config(19999,71); //初始化TIM4为PWM输出模式
- TIM2_PWMI_init(0xffff,71); //初始化TIM2为输入捕获模式
- MPU6050_Init(); //初始化MPU6050
- HMC5883_Init(); //初始化HMC5883
- MS5611_Init(); //初始化MS5611
- Data_Init();
- PID_Init();
-
- unlock(); //电调解锁
-
- TIM3_config(500,71); //初始化TIM3为定时器模式 0.5ms 任务调度开始
- return 0;
- }
- int main(void)
- {
- /*system init*/
- Init();
-
- while(1)
- {
- ;
- }
- }
复制代码
所有资料51hei提供下载:
我的四轴.rar
(75.19 KB, 下载次数: 10)
|