玩转X-CTR100 l STM32F4 l 电机正交编码器
我造轮子，你造车，创客一起造起来！塔克创新资讯【塔克社区 www.xtark.cn 】【塔克博客 www.cnblogs.com/xtark/ 】
本文介绍X-CTR100控制器的电机正交编码器，X-CTR100具有2路32位AB项正交编码器和3路16位正交编码器，共5路。
可用于电机转速和角度测量，用于智能车、机械臂、机器人制作。
原理
什么是正交？如果两个信号相位相差90度，则这两个信号称为正交。由于两个信号相差90度，因此可以根据两个信号哪个先哪个后来判断方向。
正交编码器（Quadrature Encoder）是一种用于测量旋转速度和方向的传感器，通过积分（累加）运算后，还可以用来测算距离。最常见的正交编码器有两个输出信号：A相 和 B相，有些编码器会有 Z相 的校准功能（用于消除累计误差）。「正交」一词来源于 AB 两个信号的特征，一般情况下 A相 和 B相 的输出信号总是有 π/2 的相位差。
上图中 A 和 B 分别连接到两个传感器单元上，黑白相间的圆环称之为「栅格」。传感器和栅格的实现方式有很多种：反射式传感器+不同反光率的栅格；对射式传感器+镂空光栅；霍尔传感器+磁极圆环；触点+导电轨道；等等。
例程
初始化编码器，每隔500ms采样一次编码器数值并串口输出显示。
硬件说明
硬件资源：
- 串口UART1
- RA、RB扩展接口（TIM2 32AB正交编码器接口）
- 具有正交编码器电机（需自备）
硬件连接：
软件生态
X-SOFT软件生态，X-API扩展文件如下。
ax_encoder.c——X-CTR100 电机正交编码器源文件
ax_encoder.h——X-CTR100 电机正交编码器头文件
接口函数
void AX_ENCODER_TIM2_AB_Init(uint32_t cycle); //编码器AB初始化(32位) uint32_t AX_ENCODER_TIM2_AB_GetCounter(void); //编码器AB获取计数器数值 void AX_ENCODER_TIM2_AB_SetCounter(uint32_t count); //编码器AB设置计数器数值
void AX_ENCODER_TIM5_CD_Init(uint32_t cycle); //编码器CD初始化(32位) uint32_t AX_ENCODER_TIM5_CD_GetCounter(void); //编码器CD获取计数器数值 void AX_ENCODER_TIM5_CD_SetCounter(uint32_t count); //编码器CD设置计数器数值
void AX_ENCODER_TIM3_GH_Init(uint16_t cycle); //编码器GH初始化 uint16_t AX_ENCODER_TIM3_GH_GetCounter(void); //编码器GH获取计数器数值 void AX_ENCODER_TIM3_GH_SetCounter(uint16_t count); //编码器GH设置计数器数值
void AX_ENCODER_TIM4_KL_Init(uint16_t cycle); //编码器KL初始化 uint16_t AX_ENCODER_TIM4_KL_GetCounter(void); //编码器KL获取计数器数值 void AX_ENCODER_TIM4_KL_SetCounter(uint16_t count); //编码器KL设置计数器数值
void AX_ENCODER_TIM1_OP_Init(uint16_t cycle); //编码器OP初始化 uint16_t AX_ENCODER_TIM1_OP_GetCounter(void); //编码器OP获取计数器数值 void AX_ENCODER_TIM1_OP_SetCounter(uint16_t count); //编码器OP设置计数器数值 |
软件说明
函数初始化编码器，设定编码器计数周期为60000，设置当前值为30000，while循环每隔500ms采样编码器一次，主程序代码如下。
int main(void) { //X-CTR100初始化 AX_Init(115200); printf("***电机正交编码器例程***\r\n\r\n");
//模块初始化及配置 AX_ENCODER_TIM2_AB_Init(60000); //32位正交编码器初始化，计数周期60000 AX_ENCODER_TIM5_CD_Init(60000); //32位正交编码器初始化，计数周期60000 AX_ENCODER_TIM3_GH_Init(60000); //16位正交编码器初始化，计数周期60000 AX_ENCODER_TIM4_KL_Init(60000); //16位正交编码器初始化，计数周期60000 AX_ENCODER_TIM1_OP_Init(60000); //16位正交编码器初始化，计数周期60000
//设置编码器当前计数值为30000 AX_ENCODER_TIM2_AB_SetCounter(30000); AX_ENCODER_TIM5_CD_SetCounter(30000); AX_ENCODER_TIM3_GH_SetCounter(30000); AX_ENCODER_TIM4_KL_SetCounter(30000); AX_ENCODER_TIM1_OP_SetCounter(30000);
//X-API测试：5路正交编码器测试 printf("*5路正交编码器测试\r\n");
while (1) { printf("*AB:%5d CD:%5d GH:%5d KL:%5d OP:%5d\r\n", AX_ENCODER_TIM2_AB_GetCounter(), AX_ENCODER_TIM5_CD_GetCounter(), AX_ENCODER_TIM3_GH_GetCounter(), AX_ENCODER_TIM4_KL_GetCounter(), AX_ENCODER_TIM1_OP_GetCounter()); AX_Delayms(500); } } |
实现效果
X-CTR100按照编码器接口定义连接编码器，编码器A、B接口线序可更换。手动转动编码器可观察编码器数值变化，一个方向转动编码器数值增加，另一个方向转动编码器数值减小。
参考
https://zhuanlan.zhihu.com/p/20268680
