STM32H750与TMR3111编码器的高精度角度测量实现

1. 项目背景与核心需求

在工业自动化和机器人控制领域，精确获取旋转部件的角度信息是基础且关键的技术需求。TMR3111作为一款基于隧道磁阻(TMR)技术的绝对式编码器，相比传统的光电编码器和霍尔传感器，具有更高的分辨率、更强的抗干扰能力以及更宽的工作温度范围。而STM32H750VBT6则是STMicroelectronics推出的高性能Cortex-M7内核微控制器，其丰富的外设接口和强大的运算能力，使其成为处理高精度传感器数据的理想选择。

这个项目的核心目标，是通过STM32H750VBT6微控制器准确读取TMR3111编码器输出的角度数据，并将其转化为控制系统可用的数字信号。不同于增量式编码器，TMR3111作为绝对式编码器，其输出信号包含了转轴的绝对位置信息，这消除了系统上电后需要寻找参考点的麻烦，特别适合不允许"归零"操作的关键应用场景。

2. 硬件系统设计与接口解析

2.1 TMR3111编码器电气特性

TMR3111采用标准的SPI接口进行通信，工作电压范围为3.3V-5V，与STM32H750VBT6的IO电平完全兼容。其输出信号包含：

• 12位绝对角度数据（分辨率可达0.088°）
• 转速信息（通过两次角度采样计算）
• 故障状态标志位

编码器采用单圈绝对测量方式，旋转超过360°后数据会从0重新开始。在实际应用中，如果需要多圈计数功能，需要在MCU端通过软件实现圈数累加。

2.2 STM32H750VBT6硬件连接

推荐使用STM32H750的硬件SPI接口（如SPI1）连接TMR3111，具体引脚配置如下：

注意：虽然TMR3111支持5V供电，但为了与STM32H750的IO电平匹配，建议统一使用3.3V供电。长距离传输时，应考虑增加RS-422或LVDS电平转换电路以提高抗干扰能力。

3. 软件实现与协议解析

3.1 SPI接口初始化配置

STM32H750的SPI接口需要配置为以下参数，以匹配TMR3111的通信时序：

c复制// SPI初始化结构体配置
hspi1.Instance = SPI1;
hspi1.Init.Mode = SPI_MODE_MASTER;
hspi1.Init.Direction = SPI_DIRECTION_2LINES;
hspi1.Init.DataSize = SPI_DATASIZE_16BIT; // TMR3111使用16位数据帧
hspi1.Init.CLKPolarity = SPI_POLARITY_LOW; // 时钟极性
hspi1.Init.CLKPhase = SPI_PHASE_2EDGE; // 数据在第二个边沿采样
hspi1.Init.NSS = SPI_NSS_SOFT; // 软件控制片选
hspi1.Init.BaudRatePrescaler = SPI_BAUDRATEPRESCALER_32; // 约1.25MHz @ 80MHz PCLK
hspi1.Init.FirstBit = SPI_FIRSTBIT_MSB;
hspi1.Init.TIMode = SPI_TIMODE_DISABLE;
hspi1.Init.CRCCalculation = SPI_CRCCALCULATION_DISABLE;
hspi1.Init.CRCPolynomial = 10;
if (HAL_SPI_Init(&hspi1) != HAL_OK)
{
    Error_Handler();
}

3.2 角度数据读取流程

TMR3111的数据读取遵循特定的命令序列：

1. 拉低CS片选信号，启动通信
2. 发送0xFFFF命令字（请求角度数据）
3. 接收16位响应数据（包含角度和状态位）
4. 拉高CS片选信号，结束通信

数据帧格式解析如下：

code复制bit15: 数据有效标志（1=有效）
bit14: 错误标志（1=故障）
bit13-bit0: 12位角度数据（左对齐）

对应的数据读取函数实现：

c复制#define TMR3111_CMD_READ_ANGLE 0xFFFF

uint16_t TMR3111_ReadAngle(void)
{
    uint16_t txData = TMR3111_CMD_READ_ANGLE;
    uint16_t rxData = 0;
    
    HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET); // CS拉低
    HAL_SPI_TransmitReceive(&hspi1, (uint8_t*)&txData, (uint8_t*)&rxData, 1, 100);
    HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_SET); // CS拉高
    
    if((rxData & 0x8000) == 0) {
        return 0xFFFF; // 数据无效
    }
    if((rxData & 0x4000) != 0) {
        return 0xFFFE; // 传感器故障
    }
    
    return (rxData >> 2); // 返回12位角度值
}

3.3 角度数据处理与校准

从TMR3111读取的原始数据需要经过以下处理才能得到实际角度值：

1. 将12位原始值转换为角度：

   c复制float rawToDegree(uint16_t raw) {
       return (raw / 4096.0f) * 360.0f; // 4096=2^12
   }
   

2. 零点校准：
   在实际安装中，编码器的机械零点可能与系统定义的零点存在偏差。可通过以下方法校准：

   c复制float zeroOffset = 0; // 零点偏移量
   
   void calibrateZeroPosition() {
       zeroOffset = rawToDegree(TMR3111_ReadAngle());
   }
   
   float getCalibratedAngle() {
       float angle = rawToDegree(TMR3111_ReadAngle()) - zeroOffset;
       if(angle < 0) angle += 360;
       return angle;
   }
   

3. 低通滤波处理：
   为抑制噪声，可对连续采样值进行移动平均滤波：

   c复制#define FILTER_WINDOW_SIZE 5
   float angleHistory[FILTER_WINDOW_SIZE];
   uint8_t historyIndex = 0;
   
   float filteredAngle() {
       angleHistory[historyIndex] = getCalibratedAngle();
       historyIndex = (historyIndex + 1) % FILTER_WINDOW_SIZE;
       
       float sum = 0;
       for(int i=0; i<FILTER_WINDOW_SIZE; i++) {
           sum += angleHistory[i];
       }
       return sum / FILTER_WINDOW_SIZE;
   }
   

4. 系统优化与性能提升

4.1 DMA传输优化

为提高系统效率，减少CPU占用，可以使用DMA进行SPI数据传输：

c复制// 在SPI初始化后添加DMA配置
__HAL_RCC_DMA2_CLK_ENABLE();

hdma_spi1_rx.Instance = DMA2_Stream0;
hdma_spi1_rx.Init.Channel = DMA_CHANNEL_3;
hdma_spi1_rx.Init.Direction = DMA_PERIPH_TO_MEMORY;
hdma_spi1_rx.Init.PeriphInc = DMA_PINC_DISABLE;
hdma_spi1_rx.Init.MemInc = DMA_MINC_ENABLE;
hdma_spi1_rx.Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD;
hdma_spi1_rx.Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD;
hdma_spi1_rx.Init.Mode = DMA_NORMAL;
hdma_spi1_rx.Init.Priority = DMA_PRIORITY_HIGH;
hdma_spi1_rx.Init.FIFOMode = DMA_FIFOMODE_DISABLE;
HAL_DMA_Init(&hdma_spi1_rx);

__HAL_LINKDMA(&hspi1, hdmarx, hdma_spi1_rx);

// DMA方式读取函数
uint16_t TMR3111_ReadAngle_DMA(void)
{
    uint16_t txData = TMR3111_CMD_READ_ANGLE;
    uint16_t rxData = 0;
    
    HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_RESET);
    HAL_SPI_TransmitReceive_DMA(&hspi1, (uint8_t*)&txData, (uint8_t*)&rxData, 1);
    // 实际应用中应等待DMA传输完成中断
    while(HAL_SPI_GetState(&hspi1) != HAL_SPI_STATE_READY);
    HAL_GPIO_WritePin(GPIOB, GPIO_PIN_0, GPIO_PIN_SET);
    
    return processAngleData(rxData);
}

4.2 实时性保障措施

1. 使用硬件定时器触发采样：
   配置一个硬件定时器（如TIM2）以固定频率（如1kHz）触发角度采样，确保数据更新速率恒定。

2. 中断优先级管理：

   • SPI传输完成中断：中优先级
   • 定时器触发中断：高优先级
   • 系统tick中断：最低优先级

3. 双缓冲机制：
   实现双缓冲存储角度数据，确保数据处理线程总是能获取到最新的完整数据帧。

4.3 抗干扰设计

1. 电源滤波：

   • 在TMR3111的VCC引脚就近放置10μF钽电容和0.1μF陶瓷电容
   • 必要时增加LC滤波电路

2. 信号完整性：

   • SPI信号线走线尽量短，必要时串联33Ω电阻匹配阻抗
   • 避免与高频信号线平行走线

3. 软件容错：

   c复制#define MAX_RETRY 3
   
   uint16_t robustAngleRead(void) {
       uint16_t angle;
       uint8_t retry = 0;
       
       do {
           angle = TMR3111_ReadAngle();
           if(angle != 0xFFFF && angle != 0xFFFE) {
               return angle;
           }
           retry++;
           HAL_Delay(1);
       } while(retry < MAX_RETRY);
       
       return 0xFFFF; // 读取失败
   }
   

5. 实际应用中的问题排查

5.1 常见故障现象与解决方法

5.2 调试技巧与工具使用

1. 逻辑分析仪抓包：
   使用Saleae逻辑分析仪捕获SPI总线波形，验证：

   • 命令字是否正确发送（应为0xFFFF）
   • 数据帧格式是否符合预期
   • 时序参数是否满足TMR3111规格要求

2. STM32CubeMonitor实时监控：
   配置STM32CubeMonitor工具，实时观察角度值变化曲线，快速识别异常模式。

3. 机械安装验证：
   使用角度规或高精度伺服电机作为参考，对比TMR3111输出值，验证系统精度。

5.3 性能测试指标

1. 静态精度测试：

   • 固定编码器轴，连续采样1000次
   • 计算标准差应小于0.1°

2. 动态响应测试：

   • 以恒定转速旋转编码器
   • 验证系统能跟踪的最大转速（理论值取决于采样率）
   • 检查角度值是否连续无跳变

3. 温度稳定性测试：

   • 在-40°C到+85°C温度范围内测试
   • 角度漂移应小于±0.5°

6. 系统集成与扩展应用

6.1 与电机控制系统集成

将角度数据应用于电机闭环控制的典型架构：

1. 位置环：

   c复制float targetAngle = 90.0f; // 目标角度
   float currentAngle = getCalibratedAngle();
   float positionError = targetAngle - currentAngle;
   
   // 简单的P控制器
   float motorSpeed = Kp * positionError;
   setMotorSpeed(motorSpeed);
   

2. 速度估算：
   通过两次角度采样的差值计算瞬时转速：

   c复制#define SAMPLE_INTERVAL 0.001f // 1ms采样间隔
   
   float lastAngle = 0;
   float getAngularVelocity() {
       float currentAngle = getCalibratedAngle();
       float velocity = (currentAngle - lastAngle) / SAMPLE_INTERVAL;
       lastAngle = currentAngle;
       
       // 处理360°跳变
       if(velocity > 180.0f/SAMPLE_INTERVAL) {
           velocity -= 360.0f/SAMPLE_INTERVAL;
       } else if(velocity < -180.0f/SAMPLE_INTERVAL) {
           velocity += 360.0f/SAMPLE_INTERVAL;
       }
       
       return velocity;
   }
   

6.2 多圈计数实现

虽然TMR3111是单圈编码器，但可通过软件实现多圈计数：

c复制int32_t totalTurns = 0;
float lastAngle = 0;

int32_t getMultiTurnAngle() {
    float currentAngle = getCalibratedAngle();
    float delta = currentAngle - lastAngle;
    
    // 处理360°边界穿越
    if(delta > 180.0f) {
        totalTurns--;
    } else if(delta < -180.0f) {
        totalTurns++;
    }
    
    lastAngle = currentAngle;
    return totalTurns * 360 + (int32_t)currentAngle;
}

6.3 网络化监控实现

通过STM32H750的以太网或CAN接口，将角度数据上传至监控系统：

1. 定义简单通信协议：

   c复制#pragma pack(1)
   typedef struct {
       uint8_t header[2]; // {'T','M'}
       uint32_t timestamp;
       float angle;
       float velocity;
       uint16_t status;
       uint8_t crc;
   } AngleDataFrame;
   #pragma pack()
   

2. 周期性发送数据：

   c复制void sendAngleData(void) {
       static uint32_t lastSendTime = 0;
       uint32_t now = HAL_GetTick();
       
       if(now - lastSendTime >= 10) { // 每10ms发送一次
           AngleDataFrame frame;
           frame.header[0] = 'T';
           frame.header[1] = 'M';
           frame.timestamp = now;
           frame.angle = getCalibratedAngle();
           frame.velocity = getAngularVelocity();
           frame.status = 0; // 可添加各种状态标志
           frame.crc = calculateCRC((uint8_t*)&frame, sizeof(frame)-1);
           
           // 通过以太网或CAN发送
           sendNetworkData((uint8_t*)&frame, sizeof(frame));
           
           lastSendTime = now;
       }
   }
   

在实际项目中，我发现机械安装的同心度对最终测量精度影响极大。曾经遇到一个案例，由于联轴器存在0.5mm的偏心，导致角度测量出现周期性误差，峰值达到2°之多。后来改用柔性联轴器并精心调整安装位置后，误差降低到0.1°以内。这提醒我们，高精度测量系统必须同时关注电子和机械两方面的因素。