- #include "encoder.h"
-
- void Encoder_TIM2_Init(void)
- {
- RCC_APB2PeriphResetCmd(RCC_APB2Periph_GPIOA, ENABLE);
- RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
-
- GPIO_InitTypeDef GPIO_InitStruct;
- //读数据-浮空输入
- GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IN_FLOATING;
- GPIO_InitStruct.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1;
- //不配置速度是因为速度是用来发出数据的,这GPIO是用来读取数据的
- GPIO_Init(GPIOA, &GPIO_InitStruct);
-
- TIM_InternalClockConfig(TIM2);
- TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStruct;
- TIM_TimeBaseStructInit(&TIM_TimeBaseInitStruct);
- TIM_TimeBaseInitStruct.TIM_ClockDivision = TIM_CKD_DIV1;
- TIM_TimeBaseInitStruct.TIM_CounterMode = TIM_CounterMode_Up;
- TIM_TimeBaseInitStruct.TIM_Period = 65535;
- TIM_TimeBaseInitStruct.TIM_Prescaler = 0;
- TIM_TimeBaseInit(TIM2, &TIM_TimeBaseInitStruct);
-
- //编码器特有的配置
- TIM_EncoderInterfaceConfig(TIM2, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising, TIM_ICPolarity_Rising);
-
- TIM_ICInitTypeDef TIM_ICInitStruct;
- TIM_ICStructInit(&TIM_ICInitStruct);
- //问:这个输入捕获,默认初始化通道1,那通道2就不初始化么?
- //答:STM32编码器会直接占用整个TIMx定时器通道,编码器引脚也是固定的TIMx_Ch1和TIM_Ch2,通道已被硬件固化,不需要配置。
- //滤波器的值
- TIM_ICInitStruct.TIM_ICFilter = 10;
- TIM_ICInit(TIM2, &TIM_ICInitStruct);
-
- //清理计数溢出的标志位
- TIM_ClearFlag(TIM2, TIM_FLAG_Update);
- //开启中断
- TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE);
- //计数值置0
- TIM_SetCounter(TIM2, 0);
- TIM_Cmd(TIM2, ENABLE);
- }
-
- void Encoder_TIM3_Init(void)
- {
- RCC_APB2PeriphResetCmd(RCC_APB2Periph_GPIOB, ENABLE);
- RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);
-
- GPIO_InitTypeDef GPIO_InitStruct;
- //读数据-浮空输入
- GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IN_FLOATING;
- GPIO_InitStruct.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7;
- //不配置速度是因为速度是用来发出数据的,这GPIO是用来读取数据的
- GPIO_Init(GPIOB, &GPIO_InitStruct);
-
- TIM_InternalClockConfig(TIM3);
- TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStruct;
- TIM_TimeBaseStructInit(&TIM_TimeBaseInitStruct);
- TIM_TimeBaseInitStruct.TIM_ClockDivision = TIM_CKD_DIV1;
- TIM_TimeBaseInitStruct.TIM_CounterMode = TIM_CounterMode_Up;
- TIM_TimeBaseInitStruct.TIM_Period = 65535;
- TIM_TimeBaseInitStruct.TIM_Prescaler = 0;
- TIM_TimeBaseInit(TIM3, &TIM_TimeBaseInitStruct);
-
- //编码器特有的配置
- TIM_EncoderInterfaceConfig(TIM3, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising, TIM_ICPolarity_Rising);
-
- TIM_ICInitTypeDef TIM_ICInitStruct;
- TIM_ICStructInit(&TIM_ICInitStruct);
- //问:这个输入捕获,默认初始化通道1,那通道2就不初始化么?
- //答:STM32编码器会直接占用整个TIMx定时器通道,编码器引脚也是固定的TIMx_Ch1和TIM_Ch2,通道已被硬件固化,不需要配置。
- //滤波器的值
- TIM_ICInitStruct.TIM_ICFilter = 10;
- TIM_ICInit(TIM3, &TIM_ICInitStruct);
-
- //清理计数溢出的标志位
- TIM_ClearFlag(TIM3, TIM_FLAG_Update);
- //开启中断
- TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE);
- //计数值置0
- TIM_SetCounter(TIM3, 0);
- TIM_Cmd(TIM3, ENABLE);
- }
-
-
- /**
- * @brief 编码器速度读取函数
- * @param 定时器的数字
- * @retval 读取到的定时器的值(采集编码器的计数值)
- */
- int Read_Speed(int TIMx)
- {
- int value;
- switch(TIMx)
- {
- //每采集一次就把计数器清零,即得到的计数值就是速度
- case 2:value = (short)TIM_GetCounter(TIM2);TIM_SetCounter(TIM3,0);break;
- case 3:value = (short)TIM_GetCounter(TIM3);TIM_SetCounter(TIM3,0);break;
- default:value = 0;
- }
- return value;
- }
-
- //没有用到,但是为了寻址还是先写上
- void TIM2_IRQHandler(void)
- {
- if(TIM_GetITStatus(TIM2, TIM_FLAG_Update)!=0)
- {
- TIM_ClearITPendingBit(TIM2, TIM_FLAG_Update);
- }
- }
-
- void TIM3_IRQHandler(void)
- {
- if(TIM_GetITStatus(TIM3, TIM_FLAG_Update)!=0)
- {
- TIM_ClearITPendingBit(TIM3, TIM_FLAG_Update);
- }
- }
encoder.h
- #ifndef __ENCODER_H__
- #define __ENCODER_H__
- #include "sys.h"
- void Encoder_TIM2_Init(void);
- void Encoder_TIM3_Init(void);
- int Read_Speed(int TIMx);
-
- #endif
- #include "sys.h"
-
- void PWM_TIM1_Init(uint16_t Psc, uint16_t Per)
- {
-
- RCC_APB2PeriphResetCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_TIM1 | RCC_APB2Periph_AFIO, ENABLE);
-
- GPIO_InitTypeDef GPIO_InitStruct;
- //复用推挽输出-输出PWM波形
- GPIO_InitStruct.GPIO_Mode = GPIO_Mode_AF_PP;
- GPIO_InitStruct.GPIO_Pin = GPIO_Pin_8 | GPIO_Pin_11;
- GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
- GPIO_Init(GPIOA, &GPIO_InitStruct);
-
- TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStruct;
- TIM_TimeBaseStructInit(&TIM_TimeBaseInitStruct);
- TIM_TimeBaseInitStruct.TIM_ClockDivision = TIM_CKD_DIV1;
- TIM_TimeBaseInitStruct.TIM_CounterMode = TIM_CounterMode_Up;
- TIM_TimeBaseInitStruct.TIM_Period = Per;
- TIM_TimeBaseInitStruct.TIM_Prescaler = Psc;
- TIM_TimeBaseInit(TIM1, &TIM_TimeBaseInitStruct);
-
- //初始化输出比较
- TIM_OCInitTypeDef TIM_OCInitStruct;
- TIM_OCInitStruct.TIM_OCMode = TIM_OCMode_PWM1;
- TIM_OCInitStruct.TIM_OCNPolarity = TIM_OCNPolarity_High;
- TIM_OCInitStruct.TIM_OutputNState = TIM_OutputNState_Enable;
- TIM_OCInitStruct.TIM_Pulse = 0;
- TIM_OC1Init(TIM1, &TIM_OCInitStruct);
- TIM_OC4Init(TIM1, &TIM_OCInitStruct);
-
- //高级定时器专属——MOE主输出使能
- TIM_CtrlPWMOutputs(TIM1, ENABLE);
- //预装载寄存器使能
- TIM_OC1PreloadConfig(TIM1, TIM_OCPreload_Enable);
- TIM_OC2PreloadConfig(TIM1, TIM_OCPreload_Enable);
- //TIM1在ARR上的预装载寄存器使能
- TIM_ARRPreloadConfig(TIM1, ENABLE);
- TIM_Cmd(TIM1, ENABLE);
- }
-
-
PWM.h
- #ifndef __PWM_H__
- #define __PWM_H__
- void PWM_TIM1_Init(uint16_t Psc, uint16_t Per);
-
-
- #endif
- #include "exti.h"
-
- void MPU6050_EXTI_Init(void)
- {
- RCC_APB2PeriphResetCmd(RCC_APB2Periph_GPIOB | RCC_APB2Periph_AFIO, ENABLE);
-
- GPIO_InitTypeDef GPIO_InitStruct;
- //上拉输入
- GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IPU;
- GPIO_InitStruct.GPIO_Pin = GPIO_Pin_5;
- GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
- GPIO_Init(GPIOB, &GPIO_InitStruct);
-
- GPIO_EXTILineConfig(GPIO_PortSourceGPIOB, GPIO_PinSource5);
-
- EXTI_InitTypeDef EXTI_InitStruct;
- EXTI_InitStruct.EXTI_Line = EXTI_Line5;
- EXTI_InitStruct.EXTI_LineCmd = ENABLE;
- EXTI_InitStruct.EXTI_Mode = EXTI_Mode_Interrupt;
- EXTI_InitStruct.EXTI_Trigger = EXTI_Trigger_Falling;
- EXTI_Init(&EXTI_InitStruct);
- }
-
-
exti.h
- #ifndef __EXTI_H__
- #define __EXTI_H__
- #include "sys.h"
- void MPU6050_EXTI_Init(void);
- #endif
- #include "motor.h"
-
- void Motor_Init(void)
- {
- RCC_APB2PeriphResetCmd(RCC_APB2Periph_GPIOB, ENABLE);
-
- GPIO_InitTypeDef GPIO_InitStruct;
- //复用推挽输出-输出PWM波形
- GPIO_InitStruct.GPIO_Mode = GPIO_Mode_Out_PP;
- GPIO_InitStruct.GPIO_Pin = GPIO_Pin_12 | GPIO_Pin_13 | GPIO_Pin_14 | GPIO_Pin_15;
- GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
- GPIO_Init(GPIOB, &GPIO_InitStruct);
- }
-
- //限幅函数
- void Motor_Limit(int *motoA, int *motoB)
- {
- if(*motoA>PWM_MAX) *motoA=PWM_MAX;
- if(*motoA
-
- if(*motoB>PWM_MAX) *motoB=PWM_MAX;
- if(*motoB
- }
-
- int GFP_abs(int p)
- {
- int q;
- q=(p>0)?p:(-p);
- return q;
- }
-
- //赋值函数
- //参数:PID运算完成后的PWM值
- void Load(int moto1, int moto2)
- {
- //判断正负号,决定正反转
- if(moto1>0) Ain1=1,Ain2=0;//正转
- else Ain1=0,Ain2=1;//反转
- TIM_SetCompare1(TIM1, GFP_abs(moto1));
- if(moto2>0) Bin1=1,Bin2=0;
- else Bin1=0,Bin2=1;
- TIM_SetCompare4(TIM1, GFP_abs(moto2));
- }
moto.h
- #ifndef __MOTOR_H__
- #define __MOTOR_H__
- #include "sys.h"
-
- #define Ain1 PBout(14)
- #define Ain2 PBout(15)
- #define Bin1 PBout(13)
- #define Bin2 PBout(12)
-
- void Motor_Init(void);
- void Motor_Limit(int *motoA, int *motoB);
- void Load(int moto1, int moto2);
-
- #endif
control.c
- #include "control.h"
-
- float Med_Angle=0;//机械中值
- float
- Vertical_Kp=0,
- Vertical_Kd=0;//直立环的p和d
- float
- Velocity_Kp=0,
- Velocity_Ki=0;//速度环的p和i
-
- int Vertical_out,Velocity_out,Turn_out;
- //直立环,速度环,转向环的输出
-
- void EXTI9_5_IRQHandler(void)
- {
- int PWM_out;
- //是否进入中断
- if(EXTI_GetITStatus(EXTI_Line5) != 0)//PB5
- {
- if(PBin(5)==0)//是否是PB5
- {
- EXTI_ClearITPendingBit(EXTI_Line5);//清楚中断标志位
- //1.采集编码器数据和MPU6050角度信息
- Encoder_Left = -Read_Speed(2);//电机是相对安装的,所以角度刚好相差180°,为了保持极性一致,取反
- Encoder_Right = Read_Speed(4);
-
- mpu_dmp_get_data(&Pitch,&Roll,&Yaw); //角度
- MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz);//陀螺仪——角度
- MPU_Get_Accelerometer(&aacx,&aacy,&aacz);//加速度;
- //2.把数据压入闭环控制中,计算控制输出量
- Vertical_out = Vertical(Med_Angle, Pitch, gyroy);
- Velocity_out = Velocity(Encoder_Left, Encoder_Right);
- Turn_out = Turn(gyroz);
- //公式PWM_out=真实角度+Vertical_Kp*速度环输出
- PWM_out = Vertical_out + Vertical_out * Velocity_out;//最终输出
- //3.把控制输出量加载到电机上,完成最终的控制
- MOTO1=PWM_out-Turn_out;
- MOTO2=PWM_out+Turn_out;
- Motor_Limit(&MOTO1, &MOTO2);//PWM限幅
- Load(MOTO1, MOTO2);//装载值
- }
- }
- }
-
- /**
- * @brief 直立环PD控制器: Kp*角度偏差+Kp*角度偏差的微分
- * @param 参数:期望角度,真是角度,Y轴角速度
- * @retval 直立环输出
- */
-
- int Vertical(float Med, float Angle, float gyro_Y)
- {
- int PWM_out;
-
- //角度微分为角速度,期望角度为0
- PWM_out = Vertical_Kp*Angle+Vertical_Kd*(gyro_Y-0);
-
- return PWM_out;
- }
-
-
- /**
- * @brief 速度环PI:Kp*速度的偏差+Ki*速度偏差的积分 且有编码器的速度反馈
- * @param 参数:左电机速度,右电机速度
- * @retval
- */
- int Velocity(int encoder_left, int encoder_right)
- {
- static int PWM_out,Encoder_Err,Encoder_S,EnC_Err_Lowout,EnC_Err_Lowout_last;
- float a=0.7;
- //1.计算速度偏差
- Encoder_Err=(encoder_left-encoder_right)-0;//舍去误差
- //2.对速度偏差进行低通滤波
- EnC_Err_Lowout=(1-a)*Encoder_Err+a*EnC_Err_Lowout_last;
- EnC_Err_Lowout_last=EnC_Err_Lowout;
- //速度偏差积分
- Encoder_S+=EnC_Err_Lowout;
- //积分限幅
- Encoder_S=Encoder_S>10000?10000:(Encoder_S<(-10000)?(-10000):Encoder_S);
- //速度环控制输出计算
- PWM_out=Velocity_Kp*EnC_Err_Lowout+Velocity_Ki*Encoder_S;
- return PWM_out;
- }
-
- /**
- * @brief 转向环 系数*Z轴角速度
- * @param Z轴角速度
- * @retval
- */
- int Turn(int gyro_Z)
- {
- int PWM_out;
- PWM_out = (-0.5)*gyro_Z;
- return PWM_out;
- }
control.h
- #ifndef __CONTOROL_H__
- #define __CONTOROL_H__
- #include "sys.h"
-
- int Vertical(float Med, float Angle, float gyro_Y);
- int Velocity(int encoder_left, int encoder_right);
- int Turn(int gyro_Z);
- void EXTI9_5_IRQHandler(void);
- #endif
main.c
- #include "sys.h"
- #include "oled.h"
-
- int PWM_MAX=7200,PWM_MIN=-7200;
- int MOTO1, MOTO2;
- float Pitch,Roll,Yaw; //角度
- short gyrox,gyroy,gyroz; //陀螺仪——角度
- short aacx,aacy,aacz; //加速度
- int Encoder_Left, Encoder_Right;//编码器数据(速度)
-
- int main(void)
- {
- NVIC_Config();
- uart1_init(115200);
-
- OLED_Init();
- OLED_Clear();
-
- MPU_Init();
- mpu_dmp_init();
-
- Encoder_TIM2_Init();
- Encoder_TIM3_Init();
- MPU6050_EXTI_Init();
- Motor_Init();
- PWM_TIM1_Init(1, 7199);//分配,重装载值
-
- while(1)
- {
- //OLED_Float(
- }
- }
移植文件
sys.c
- #include "sys.h"
-
- void NVIC_Config(void)
- {
- NVIC_InitTypeDef NVIC_InitStruct;
-
- NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
- //外部中断
- NVIC_InitStruct.NVIC_IRQChannel=EXTI9_5_IRQn;
- NVIC_InitStruct.NVIC_IRQChannelCmd=ENABLE;
- NVIC_InitStruct.NVIC_IRQChannelPreemptionPriority=0;
- NVIC_InitStruct.NVIC_IRQChannelSubPriority=0;
- NVIC_Init(&NVIC_InitStruct);
-
- //串口
- NVIC_InitStruct.NVIC_IRQChannel=USART1_IRQn;
- NVIC_InitStruct.NVIC_IRQChannelCmd=ENABLE;
- NVIC_InitStruct.NVIC_IRQChannelPreemptionPriority=2;
- NVIC_InitStruct.NVIC_IRQChannelSubPriority=2;
- NVIC_Init(&NVIC_InitStruct);
-
- }
-
-
- #ifndef __SYS_H
- #define __SYS_H
-
-
-
- #include "stm32f10x.h"
- #include "delay.h"
- #include "usart.h"
- #include "inv_mpu.h"
- #include "inv_mpu_dmp_motion_driver.h"
- #include "mpu6050.h"
- #include "control.h"
- #include "OLED.h"
- #include "pwm.h"
- #include "encoder.h"
- #include "exti.h"
- #include "motor.h"
-
-
-
- #include
- #include
- #include
- #include
- #include
- #include
- //位带操作,实现51类似的GPIO控制功能
- //具体实现思想,参考<
>第五章(87页~92页). - //IO口操作宏定义
- #define BITBAND(addr, bitnum) ((addr & 0xF0000000)+0x2000000+((addr &0xFFFFF)<<5)+(bitnum<<2))
- #define MEM_ADDR(addr) *((volatile unsigned long *)(addr))
- #define BIT_ADDR(addr, bitnum) MEM_ADDR(BITBAND(addr, bitnum))
- //IO口地址映射
- #define GPIOA_ODR_Addr (GPIOA_BASE+12) //0x4001080C
- #define GPIOB_ODR_Addr (GPIOB_BASE+12) //0x40010C0C
- #define GPIOC_ODR_Addr (GPIOC_BASE+12) //0x4001100C
- #define GPIOD_ODR_Addr (GPIOD_BASE+12) //0x4001140C
- #define GPIOE_ODR_Addr (GPIOE_BASE+12) //0x4001180C
- #define GPIOF_ODR_Addr (GPIOF_BASE+12) //0x40011A0C
- #define GPIOG_ODR_Addr (GPIOG_BASE+12) //0x40011E0C
-
- #define GPIOA_IDR_Addr (GPIOA_BASE+8) //0x40010808
- #define GPIOB_IDR_Addr (GPIOB_BASE+8) //0x40010C08
- #define GPIOC_IDR_Addr (GPIOC_BASE+8) //0x40011008
- #define GPIOD_IDR_Addr (GPIOD_BASE+8) //0x40011408
- #define GPIOE_IDR_Addr (GPIOE_BASE+8) //0x40011808
- #define GPIOF_IDR_Addr (GPIOF_BASE+8) //0x40011A08
- #define GPIOG_IDR_Addr (GPIOG_BASE+8) //0x40011E08
-
- //IO口操作,只对单一的IO口!
- //确保n的值小于16!
- #define PAout(n) BIT_ADDR(GPIOA_ODR_Addr,n) //输出
- #define PAin(n) BIT_ADDR(GPIOA_IDR_Addr,n) //输入
-
- #define PBout(n) BIT_ADDR(GPIOB_ODR_Addr,n) //输出
- #define PBin(n) BIT_ADDR(GPIOB_IDR_Addr,n) //输入
-
- #define PCout(n) BIT_ADDR(GPIOC_ODR_Addr,n) //输出
- #define PCin(n) BIT_ADDR(GPIOC_IDR_Addr,n) //输入
-
- #define PDout(n) BIT_ADDR(GPIOD_ODR_Addr,n) //输出
- #define PDin(n) BIT_ADDR(GPIOD_IDR_Addr,n) //输入
-
- #define PEout(n) BIT_ADDR(GPIOE_ODR_Addr,n) //输出
- #define PEin(n) BIT_ADDR(GPIOE_IDR_Addr,n) //输入
-
- #define PFout(n) BIT_ADDR(GPIOF_ODR_Addr,n) //输出
- #define PFin(n) BIT_ADDR(GPIOF_IDR_Addr,n) //输入
-
- #define PGout(n) BIT_ADDR(GPIOG_ODR_Addr,n) //输出
- #define PGin(n) BIT_ADDR(GPIOG_IDR_Addr,n) //输入
-
- /
- //Ex_NVIC_Config专用定义
- #define GPIO_A 0
- #define GPIO_B 1
- #define GPIO_C 2
- #define GPIO_D 3
- #define GPIO_E 4
- #define GPIO_F 5
- #define GPIO_G 6
-
- #define FTIR 1 //下降沿触发
- #define RTIR 2 //上升沿触发
-
- //JTAG模式设置定义
- #define JTAG_SWD_DISABLE 0X02
- #define SWD_ENABLE 0X01
- #define JTAG_SWD_ENABLE 0X00
-
- extern int PWM_MAX,PWM_MIN;
- extern int MOTO1, MOTO2;
- extern float Pitch,Roll,Yaw; //角度
- extern short gyrox,gyroy,gyroz;//陀螺仪——角度
- extern short aacx,aacy,aacz; //加速度
- extern int Encoder_Left, Encoder_Right;
- void NVIC_Config(void);
- #endif
mpu6050.c
- #include "mpu6050.h"
- #include "sys.h"
- #include "delay.h"
- #include "usart.h"
-
-
-
- //初始化MPU6050
- //返回值:0,成功
- //其他,错误代码
- u8 MPU_Init(void)
- {
- u8 res;
- MPU_IIC_Init();//初始化IIC总线
- MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X80); //复位MPU6050
- delay_ms(100);
- MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X00); //唤醒MPU6050
- MPU_Set_Gyro_Fsr(3); //陀螺仪传感器,±2000dps
- MPU_Set_Accel_Fsr(0); //加速度传感器,±2g
- MPU_Set_Rate(200); //设置采样率50Hz
- MPU_Write_Byte(MPU_INT_EN_REG,0X00); //关闭所有中断
- MPU_Write_Byte(MPU_USER_CTRL_REG,0X00); //I2C主模式关闭
- MPU_Write_Byte(MPU_FIFO_EN_REG,0X00); //关闭FIFO
- MPU_Write_Byte(MPU_INTBP_CFG_REG,0X80); //INT引脚低电平有效
- res=MPU_Read_Byte(MPU_DEVICE_ID_REG);
- if(res==MPU_ADDR)//器件ID正确
- {
- MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X01); //设置CLKSEL,PLL X轴为参考
- MPU_Write_Byte(MPU_PWR_MGMT2_REG,0X00); //加速度与陀螺仪都工作
- MPU_Set_Rate(200); //设置采样率为50Hz
- }else return 1;
- return 0;
- }
- //设置MPU6050陀螺仪传感器满量程范围
- //fsr:0,±250dps;1,±500dps;2,±1000dps;3,±2000dps
- //返回值:0,设置成功
- // 其他,设置失败
- u8 MPU_Set_Gyro_Fsr(u8 fsr)
- {
- return MPU_Write_Byte(MPU_GYRO_CFG_REG,fsr<<3);//设置陀螺仪满量程范围
- }
- //设置MPU6050加速度传感器满量程范围
- //fsr:0,±2g;1,±4g;2,±8g;3,±16g
- //返回值:0,设置成功
- // 其他,设置失败
- u8 MPU_Set_Accel_Fsr(u8 fsr)
- {
- return MPU_Write_Byte(MPU_ACCEL_CFG_REG,fsr<<3);//设置加速度传感器满量程范围
- }
- //设置MPU6050的数字低通滤波器
- //lpf:数字低通滤波频率(Hz)
- //返回值:0,设置成功
- // 其他,设置失败
- u8 MPU_Set_LPF(u16 lpf)
- {
- u8 data=0;
- if(lpf>=188)data=1;
- else if(lpf>=98)data=2;
- else if(lpf>=42)data=3;
- else if(lpf>=20)data=4;
- else if(lpf>=10)data=5;
- else data=6;
- return MPU_Write_Byte(MPU_CFG_REG,data);//设置数字低通滤波器
- }
- //设置MPU6050的采样率(假定Fs=1KHz)
- //rate:4~1000(Hz)
- //返回值:0,设置成功
- // 其他,设置失败
- u8 MPU_Set_Rate(u16 rate)
- {
- u8 data;
- if(rate>1000)rate=1000;
- if(rate<4)rate=4;
- data=1000/rate-1;
- data=MPU_Write_Byte(MPU_SAMPLE_RATE_REG,data); //设置数字低通滤波器
- return MPU_Set_LPF(rate/2); //自动设置LPF为采样率的一半
- }
-
- //得到温度值
- //返回值:温度值(扩大了100倍)
- short MPU_Get_Temperature(void)
- {
- u8 buf[2];
- short raw;
- float temp;
- MPU_Read_Len(MPU_ADDR,MPU_TEMP_OUTH_REG,2,buf);
- raw=((u16)buf[0]<<8)|buf[1];
- temp=36.53+((double)raw)/340;
- return temp*100;;
- }
- //得到陀螺仪值(原始值)
- //gx,gy,gz:陀螺仪x,y,z轴的原始读数(带符号)
- //返回值:0,成功
- // 其他,错误代码
- u8 MPU_Get_Gyroscope(short *gx,short *gy,short *gz)
- {
- u8 buf[6],res;
- res=MPU_Read_Len(MPU_ADDR,MPU_GYRO_XOUTH_REG,6,buf);
- if(res==0)
- {
- *gx=((u16)buf[0]<<8)|buf[1];
- *gy=((u16)buf[2]<<8)|buf[3];
- *gz=((u16)buf[4]<<8)|buf[5];
- }
- return res;;
- }
- //得到加速度值(原始值)
- //gx,gy,gz:陀螺仪x,y,z轴的原始读数(带符号)
- //返回值:0,成功
- // 其他,错误代码
- u8 MPU_Get_Accelerometer(short *ax,short *ay,short *az)
- {
- u8 buf[6],res;
- res=MPU_Read_Len(MPU_ADDR,MPU_ACCEL_XOUTH_REG,6,buf);
- if(res==0)
- {
- *ax=((u16)buf[0]<<8)|buf[1];
- *ay=((u16)buf[2]<<8)|buf[3];
- *az=((u16)buf[4]<<8)|buf[5];
- }
- return res;;
- }
- //IIC连续写
- //addr:器件地址
- //reg:寄存器地址
- //len:写入长度
- //buf:数据区
- //返回值:0,正常
- // 其他,错误代码
- u8 MPU_Write_Len(u8 addr,u8 reg,u8 len,u8 *buf)
- {
- u8 i;
- MPU_IIC_Start();
- MPU_IIC_Send_Byte((addr<<1)|0);//发送器件地址+写命令
- if(MPU_IIC_Wait_Ack()) //等待应答
- {
- MPU_IIC_Stop();
- return 1;
- }
- MPU_IIC_Send_Byte(reg); //写寄存器地址
- MPU_IIC_Wait_Ack(); //等待应答
- for(i=0;i
- {
- MPU_IIC_Send_Byte(buf[i]); //发送数据
- if(MPU_IIC_Wait_Ack()) //等待ACK
- {
- MPU_IIC_Stop();
- return 1;
- }
- }
- MPU_IIC_Stop();
- return 0;
- }
- //IIC连续读
- //addr:器件地址
- //reg:要读取的寄存器地址
- //len:要读取的长度
- //buf:读取到的数据存储区
- //返回值:0,正常
- // 其他,错误代码
- u8 MPU_Read_Len(u8 addr,u8 reg,u8 len,u8 *buf)
- {
- MPU_IIC_Start();
- MPU_IIC_Send_Byte((addr<<1)|0);//发送器件地址+写命令
- if(MPU_IIC_Wait_Ack()) //等待应答
- {
- MPU_IIC_Stop();
- return 1;
- }
- MPU_IIC_Send_Byte(reg); //写寄存器地址
- MPU_IIC_Wait_Ack(); //等待应答
- MPU_IIC_Start();
- MPU_IIC_Send_Byte((addr<<1)|1);//发送器件地址+读命令
- MPU_IIC_Wait_Ack(); //等待应答
- while(len)
- {
- if(len==1)*buf=MPU_IIC_Read_Byte(0);//读数据,发送nACK
- else *buf=MPU_IIC_Read_Byte(1); //读数据,发送ACK
- len--;
- buf++;
- }
- MPU_IIC_Stop(); //产生一个停止条件
- return 0;
- }
- //IIC写一个字节
- //reg:寄存器地址
- //data:数据
- //返回值:0,正常
- // 其他,错误代码
- u8 MPU_Write_Byte(u8 reg,u8 data)
- {
- MPU_IIC_Start();
- MPU_IIC_Send_Byte((MPU_ADDR<<1)|0);//发送器件地址+写命令
- if(MPU_IIC_Wait_Ack()) //等待应答
- {
- MPU_IIC_Stop();
- return 1;
- }
- MPU_IIC_Send_Byte(reg); //写寄存器地址
- MPU_IIC_Wait_Ack(); //等待应答
- MPU_IIC_Send_Byte(data);//发送数据
- if(MPU_IIC_Wait_Ack()) //等待ACK
- {
- MPU_IIC_Stop();
- return 1;
- }
- MPU_IIC_Stop();
- return 0;
- }
- //IIC读一个字节
- //reg:寄存器地址
- //返回值:读到的数据
- u8 MPU_Read_Byte(u8 reg)
- {
- u8 res;
- MPU_IIC_Start();
- MPU_IIC_Send_Byte((MPU_ADDR<<1)|0);//发送器件地址+写命令
- MPU_IIC_Wait_Ack(); //等待应答
- MPU_IIC_Send_Byte(reg); //写寄存器地址
- MPU_IIC_Wait_Ack(); //等待应答
- MPU_IIC_Start();
- MPU_IIC_Send_Byte((MPU_ADDR<<1)|1);//发送器件地址+读命令
- MPU_IIC_Wait_Ack(); //等待应答
- res=MPU_IIC_Read_Byte(0);//读取数据,发送nACK
- MPU_IIC_Stop(); //产生一个停止条件
- return res;
- }
-
mpu6050.h
- #ifndef __MPU6050_H
- #define __MPU6050_H
- #include "mpuiic.h"
- //
- //本程序只供学习使用,未经作者许可,不得用于其它任何用途
- //ALIENTEK MiniSTM32F103开发板
- //MPU6050 驱动代码
- //正点原子@ALIENTEK
- //技术论坛:www.openedv.com
- //创建日期:2015/4/18
- //版本:V1.0
- //版权所有,盗版必究。
- //Copyright(C) 广州市星翼电子科技有限公司 2009-2019
- //All rights reserved
- //
-
- //#define MPU_ACCEL_OFFS_REG 0X06 //accel_offs寄存器,可读取版本号,寄存器手册未提到
- //#define MPU_PROD_ID_REG 0X0C //prod id寄存器,在寄存器手册未提到
- #define MPU_SELF_TESTX_REG 0X0D //自检寄存器X
- #define MPU_SELF_TESTY_REG 0X0E //自检寄存器Y
- #define MPU_SELF_TESTZ_REG 0X0F //自检寄存器Z
- #define MPU_SELF_TESTA_REG 0X10 //自检寄存器A
- #define MPU_SAMPLE_RATE_REG 0X19 //采样频率分频器
- #define MPU_CFG_REG 0X1A //配置寄存器
- #define MPU_GYRO_CFG_REG 0X1B //陀螺仪配置寄存器
- #define MPU_ACCEL_CFG_REG 0X1C //加速度计配置寄存器
- #define MPU_MOTION_DET_REG 0X1F //运动检测阀值设置寄存器
- #define MPU_FIFO_EN_REG 0X23 //FIFO使能寄存器
- #define MPU_I2CMST_CTRL_REG 0X24 //IIC主机控制寄存器
- #define MPU_I2CSLV0_ADDR_REG 0X25 //IIC从机0器件地址寄存器
- #define MPU_I2CSLV0_REG 0X26 //IIC从机0数据地址寄存器
- #define MPU_I2CSLV0_CTRL_REG 0X27 //IIC从机0控制寄存器
- #define MPU_I2CSLV1_ADDR_REG 0X28 //IIC从机1器件地址寄存器
- #define MPU_I2CSLV1_REG 0X29 //IIC从机1数据地址寄存器
- #define MPU_I2CSLV1_CTRL_REG 0X2A //IIC从机1控制寄存器
- #define MPU_I2CSLV2_ADDR_REG 0X2B //IIC从机2器件地址寄存器
- #define MPU_I2CSLV2_REG 0X2C //IIC从机2数据地址寄存器
- #define MPU_I2CSLV2_CTRL_REG 0X2D //IIC从机2控制寄存器
- #define MPU_I2CSLV3_ADDR_REG 0X2E //IIC从机3器件地址寄存器
- #define MPU_I2CSLV3_REG 0X2F //IIC从机3数据地址寄存器
- #define MPU_I2CSLV3_CTRL_REG 0X30 //IIC从机3控制寄存器
- #define MPU_I2CSLV4_ADDR_REG 0X31 //IIC从机4器件地址寄存器
- #define MPU_I2CSLV4_REG 0X32 //IIC从机4数据地址寄存器
- #define MPU_I2CSLV4_DO_REG 0X33 //IIC从机4写数据寄存器
- #define MPU_I2CSLV4_CTRL_REG 0X34 //IIC从机4控制寄存器
- #define MPU_I2CSLV4_DI_REG 0X35 //IIC从机4读数据寄存器
-
- #define MPU_I2CMST_STA_REG 0X36 //IIC主机状态寄存器
- #define MPU_INTBP_CFG_REG 0X37 //中断/旁路设置寄存器
- #define MPU_INT_EN_REG 0X38 //中断使能寄存器
- #define MPU_INT_STA_REG 0X3A //中断状态寄存器
-
- #define MPU_ACCEL_XOUTH_REG 0X3B //加速度值,X轴高8位寄存器
- #define MPU_ACCEL_XOUTL_REG 0X3C //加速度值,X轴低8位寄存器
- #define MPU_ACCEL_YOUTH_REG 0X3D //加速度值,Y轴高8位寄存器
- #define MPU_ACCEL_YOUTL_REG 0X3E //加速度值,Y轴低8位寄存器
- #define MPU_ACCEL_ZOUTH_REG 0X3F //加速度值,Z轴高8位寄存器
- #define MPU_ACCEL_ZOUTL_REG 0X40 //加速度值,Z轴低8位寄存器
-
- #define MPU_TEMP_OUTH_REG 0X41 //温度值高八位寄存器
- #define MPU_TEMP_OUTL_REG 0X42 //温度值低8位寄存器
-
- #define MPU_GYRO_XOUTH_REG 0X43 //陀螺仪值,X轴高8位寄存器
- #define MPU_GYRO_XOUTL_REG 0X44 //陀螺仪值,X轴低8位寄存器
- #define MPU_GYRO_YOUTH_REG 0X45 //陀螺仪值,Y轴高8位寄存器
- #define MPU_GYRO_YOUTL_REG 0X46 //陀螺仪值,Y轴低8位寄存器
- #define MPU_GYRO_ZOUTH_REG 0X47 //陀螺仪值,Z轴高8位寄存器
- #define MPU_GYRO_ZOUTL_REG 0X48 //陀螺仪值,Z轴低8位寄存器
-
- #define MPU_I2CSLV0_DO_REG 0X63 //IIC从机0数据寄存器
- #define MPU_I2CSLV1_DO_REG 0X64 //IIC从机1数据寄存器
- #define MPU_I2CSLV2_DO_REG 0X65 //IIC从机2数据寄存器
- #define MPU_I2CSLV3_DO_REG 0X66 //IIC从机3数据寄存器
-
- #define MPU_I2CMST_DELAY_REG 0X67 //IIC主机延时管理寄存器
- #define MPU_SIGPATH_RST_REG 0X68 //信号通道复位寄存器
- #define MPU_MDETECT_CTRL_REG 0X69 //运动检测控制寄存器
- #define MPU_USER_CTRL_REG 0X6A //用户控制寄存器
- #define MPU_PWR_MGMT1_REG 0X6B //电源管理寄存器1
- #define MPU_PWR_MGMT2_REG 0X6C //电源管理寄存器2
- #define MPU_FIFO_CNTH_REG 0X72 //FIFO计数寄存器高八位
- #define MPU_FIFO_CNTL_REG 0X73 //FIFO计数寄存器低八位
- #define MPU_FIFO_RW_REG 0X74 //FIFO读写寄存器
- #define MPU_DEVICE_ID_REG 0X75 //器件ID寄存器
-
- //如果AD0脚(9脚)接地,IIC地址为0X68(不包含最低位).
- //如果接V3.3,则IIC地址为0X69(不包含最低位).
- #define MPU_ADDR 0X68
-
-
- 因为模块AD0默认接GND,所以转为读写地址后,为0XD1和0XD0(如果接VCC,则为0XD3和0XD2)
- //#define MPU_READ 0XD1
- //#define MPU_WRITE 0XD0
-
- u8 MPU_Init(void); //初始化MPU6050
- u8 MPU_Write_Len(u8 addr,u8 reg,u8 len,u8 *buf);//IIC连续写
- u8 MPU_Read_Len(u8 addr,u8 reg,u8 len,u8 *buf); //IIC连续读
- u8 MPU_Write_Byte(u8 reg,u8 data); //IIC写一个字节
- u8 MPU_Read_Byte(u8 reg); //IIC读一个字节
-
- u8 MPU_Set_Gyro_Fsr(u8 fsr);
- u8 MPU_Set_Accel_Fsr(u8 fsr);
- u8 MPU_Set_LPF(u16 lpf);
- u8 MPU_Set_Rate(u16 rate);
- u8 MPU_Set_Fifo(u8 sens);
-
-
- short MPU_Get_Temperature(void);
- u8 MPU_Get_Gyroscope(short *gx,short *gy,short *gz);
- u8 MPU_Get_Accelerometer(short *ax,short *ay,short *az);
-
- #endif
usart.c
- #include "usart.h"
-
-
-
- //加入以下代码,支持printf函数,而不需要选择use MicroLIB
- #if 1
- #pragma import(__use_no_semihosting)
- //标准库需要的支持函数
- struct __FILE
- {
- int handle;
-
- };
-
- FILE __stdout;
- //定义_sys_exit()以避免使用半主机模式
- _sys_exit(int x)
- {
- x = x;
- }
- //重定义fputc函数
- int fputc(int ch, FILE *f)
- {
- while((USART1->SR&0X40)==0);//循环发送,直到发送完毕
- USART1->DR = (u8) ch;
- return ch;
- }
- #endif
-
- /*使用microLib的方法*/
- /*
- int fputc(int ch, FILE *f)
- {
- USART_SendData(USART1, (uint8_t) ch);
- while (USART_GetFlagStatus(USART1, USART_FLAG_TC) == RESET) {}
-
- return ch;
- }
- int GetKey (void) {
- while (!(USART1->SR & USART_FLAG_RXNE));
- return ((int)(USART1->DR & 0x1FF));
- }
- */
-
- u8 USART_RX_BUF[64]; //接收缓冲,最大64个字节.
- //接收状态
- //bit7,接收完成标志
- //bit6,接收到0x0d
- //bit5~0,接收到的有效字节数目
- u8 USART_RX_STA=0; //接收状态标记
-
- void uart1_init(u32 bound)
- {
- //GPIO端口设置
- GPIO_InitTypeDef GPIO_InitStructure;
- USART_InitTypeDef USART_InitStructure;
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_USART1|RCC_APB2Periph_GPIOA|RCC_APB2Periph_AFIO, ENABLE);
- //USART1_TX PA.9
- GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9;
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
- GPIO_Init(GPIOA, &GPIO_InitStructure);
- //USART1_RX PA.10
- GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;
- GPIO_Init(GPIOA, &GPIO_InitStructure);
- //USART 初始化设置
- USART_InitStructure.USART_BaudRate = bound;//一般设置为9600;
- USART_InitStructure.USART_WordLength = USART_WordLength_8b;
- USART_InitStructure.USART_StopBits = USART_StopBits_1;
- USART_InitStructure.USART_Parity = USART_Parity_No;
- USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;
- USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx;
- USART_Init(USART1, &USART_InitStructure);
- USART_ITConfig(USART1, USART_IT_RXNE, ENABLE);//开启中断
- USART_Cmd(USART1, ENABLE); //使能串口
- }
-
- void USART1_IRQHandler(void) //串口1中断服务程序
- {
- u8 Res;
- if(USART_GetITStatus(USART1, USART_IT_RXNE) != RESET) //接收中断(接收到的数据必须是0x0d 0x0a结尾)
- {
- Res =USART_ReceiveData(USART1);//(USART1->DR); //读取接收到的数据
-
- if((USART_RX_STA&0x80)==0)//接收未完成
- {
- if(USART_RX_STA&0x40)//接收到了0x0d
- {
- if(Res!=0x0a)USART_RX_STA=0;//接收错误,重新开始
- else USART_RX_STA|=0x80; //接收完成了
- }
- else //还没收到0X0D
- {
- if(Res==0x0d)USART_RX_STA|=0x40;
- else
- {
- USART_RX_BUF[USART_RX_STA&0X3F]=Res ;
- USART_RX_STA++;
- if(USART_RX_STA>63)USART_RX_STA=0;//接收数据错误,重新开始接收
- }
- }
- }
- }
- }
.h
- #ifndef __USART_H
- #define __USART_H
- #include "stdio.h"
- #include "sys.h"
-
-
- void uart1_init(u32 bound); //串口1初始化函数
- void USART1_IRQHandler(void); //串口1中断服务程序
- #endif
-
-
相关阅读:
NumPy 数组排序、过滤与随机数生成详解
PTA 1079 延迟的回文数(Python3)
Exception(异常) 和 Error(错误)区别解析
java计算机毕业设计智能健身房管理源码+mysql数据库+系统+部署+lw文档
最新外卖点餐小程序开源源码 支持单店+多店双模式 含完整前后端代码包和搭建教程
数学建模国赛拿奖关键tips,错过这7条可能与国奖无缘!
基于JavaSwing开发任务管理器 课程设计 大作业源码
CSDN 成为开放原子开源基金会黄金捐赠人,共建中国十万亿技术大生态
面试官:深度不够,建议回去深挖
c++高精度乘法
-
原文地址:https://blog.csdn.net/m0_74460550/article/details/134023236