第一步:AS5600 I2C驱动移植与角度读取实战
1. AS5600磁编码器与I2C通信基础AS5600是AMS公司推出的一款高精度磁旋转位置传感器采用非接触式设计通过检测磁场变化来测量角度。它内置12位ADC能够提供4096个位置点理论分辨率达到0.088度。在实际项目中我经常用它来做电机位置检测或者旋钮角度测量效果非常稳定。这个传感器支持多种接口方式包括模拟输出、PWM输出和数字接口I2C。我们这里重点讲I2C接口因为它布线简单只需要SCL和SDA两根线而且可以直接读取数字量不需要额外的ADC电路。I2C的时钟频率最高支持到1MHz但实际使用中我一般设置为400kHz这个速度已经足够快而且稳定性更好。AS5600的I2C设备地址是0x36这个地址是固定的不能修改。角度值存储在0x0C和0x0D两个寄存器中分别是高8位和低8位。读取时需要先发送寄存器地址然后再读取数据。这里有个小技巧AS5600支持连续读取也就是说你可以先指定起始寄存器地址然后连续读取多个寄存器这样可以减少通信次数。2. STM32硬件I2C配置实战我用的是STM32F103VET6这款芯片属于中容量产品有2个I2C接口。在实际项目中我更倾向于使用硬件I2C而不是软件模拟因为硬件I2C更稳定而且不占用CPU资源。首先要用STM32CubeMX配置I2C外设。打开软件后在Pinout界面找到I2C1选择I2C模式。我通常把SCL配置在PB6SDA配置在PB7这是官方推荐的引脚。在Configuration标签页里设置I2C参数时钟速度400kHz模式I2C地址模式7位自己的地址随便设一个因为我们是主设备生成代码后HAL库会自动初始化I2C外设。这里有个坑要注意STM32的I2C外设有时候会出现卡死的情况特别是在通信失败后。我的解决办法是每次通信前都检查总线状态如果发现异常就重新初始化I2C。void I2C_Reset(I2C_HandleTypeDef *hi2c) { hi2c-Instance-CR1 | I2C_CR1_SWRST; hi2c-Instance-CR1 ~I2C_CR1_SWRST; HAL_I2C_Init(hi2c); }3. AS5600驱动移植详解SimpleFOC项目中已经有一个成熟的AS5600驱动我们要做的就是把它移植到自己的工程里。驱动主要包含三个部分I2C底层驱动、传感器抽象层和AS5600专用驱动。首先把SimpleFOC中的这几个文件复制到你的工程MagneticSensorI2C.h/cSensor.h/cfoc_utils.h在MagneticSensorI2C.c文件中已经定义好了AS5600的配置结构体MagneticSensorI2CConfig AS5600_I2C { .chip_address 0x36, .bit_resolution 12, .angle_register 0x0C, .data_start_bit 11 };这个结构体告诉驱动设备地址是0x36分辨率是12位角度寄存器从0x0C开始有效数据从第11位开始移植时最重要的是实现I2C的读写函数。SimpleFOC使用了一个iic结构体来抽象I2C操作我们需要根据自己使用的硬件来实现这些函数。如果你用的是HAL库可以这样实现unsigned char I2C_Read(unsigned char addr, unsigned char reg, unsigned char len, unsigned char *buf) { HAL_StatusTypeDef status HAL_I2C_Mem_Read(hi2c1, addr1, reg, I2C_MEMADD_SIZE_8BIT, buf, len, 100); return (status HAL_OK) ? 0 : 1; }4. 角度读取与数据处理驱动移植好后就可以读取角度数据了。首先需要初始化传感器iic i2c1; MagneticSensor_i2c as5600; new_IIC_config(i2c1,B,B,6,7); // SCLPB6, SDAPB7 new_MagneticSensor_i2c(as5600,AS5600_I2C); as5600.init(as5600,i2c1);读取角度数据时要注意AS5600返回的是原始计数值需要转换成实际角度。SimpleFOC的驱动已经帮我们做好了转换float getAngle() { as5600.SenSor.update(as5600); return as5600.SenSor.getAngle(as5600); }这个函数返回的是弧度值范围是0-2π。如果你需要角度值可以自己转换float angle_deg getAngle() * 180 / PI;在实际使用中我发现AS5600的输出非常平滑几乎没有跳动。但是如果你需要更精确的数据可以考虑以下几点多次采样取平均使用软件滤波如滑动平均或卡尔曼滤波校准零位消除安装偏差5. 调试技巧与常见问题调试I2C设备时逻辑分析仪是必不可少的工具。我用的是一款国产的Saleae克隆版价格不贵但很好用。通过抓取I2C波形可以清楚地看到通信过程快速定位问题。常见问题及解决方法读取失败检查I2C地址是否正确AS5600是0x36用逻辑分析仪确认是否有应答信号。数据跳动大确保磁铁与传感器距离合适1-3mm检查电源是否稳定添加滤波电容我在VDD和GND之间加了0.1uF和10uF电容角度值不更新确认每次读取前都调用了update()函数检查I2C时钟速度是否合适太快可能导致通信失败STM32 I2C卡死添加超时机制出错时重置I2C外设考虑使用软件I2C作为备用方案调试时可以先用这个简单的测试代码while(1) { float angle getAngle(); printf(Angle: %.2f\n, angle); HAL_Delay(100); }如果能在串口助手上看到连续变化的角度值说明驱动工作正常。6. 性能优化与高级应用当基本功能调通后我们可以考虑做一些优化。首先是读取速度AS5600支持快速模式Fast Mode Plus时钟可以达到1MHz。但实际测试发现在400kHz时稳定性最好。为了提高实时性可以考虑使用DMA传输。STM32的I2C支持DMA可以显著降低CPU占用率。配置方法是在CubeMX中启用I2C的DMA选项然后使用HAL_I2C_Mem_Read_DMA函数。另一个优化点是数据处理。SimpleFOC驱动中已经实现了速度计算功能可以直接调用float velocity as5600.SenSor.getVelocity(as5600);这个速度值是通过角度差分计算得到的单位是rad/s。如果你需要更平滑的速度信号可以适当调整驱动中的滤波参数。对于需要绝对位置的应用比如机器人关节还需要处理多圈计数。SimpleFOC驱动已经内置了这个功能int full_rotations as5600.SenSor.getFullRotations(as5600); float total_angle full_rotations * 2 * PI current_angle;7. 实际项目经验分享在最近的一个四足机器人项目中我用了8个AS5600来检测关节角度。刚开始遇到了I2C总线干扰的问题后来通过以下措施解决了每条I2C总线不超过3个设备总线长度控制在20cm以内添加了4.7kΩ上拉电阻使用双绞线连接另一个经验是关于磁铁安装的。AS5600对磁铁的极性和位置很敏感磁铁必须是径向磁化的磁铁中心要对准传感器中心最佳气隙距离是1-3mm我曾经因为磁铁装偏了5度导致角度线性度变差。后来用3D打印了一个定位夹具问题就解决了。最后提醒一点AS5600的零位是出厂校准的但如果你需要自定义零位可以通过编程设置。方法是向ZPOS寄存器0x01和0x02写入新的零位值。不过要注意这个设置是易失性的断电后会丢失。如果需要永久保存可以写入到ZPOS和MPOS寄存器然后烧写OTP。
本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/2423214.html
如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!