STM32 软件I2C方式读取MT6701磁编码器获取角度例程
- 📍相关篇《STM32 软件I2C方式读取AS5600磁编码器获取角度例程》
- 🌿《Arduino通过I2C驱动MT6701磁编码器并读取角度数据》
- 🔰MT6701芯片和AS5600从软件读取对比,只是读取的寄存器和访问的设备地址不同而已,所以稍作修改即可实现通用一个驱动模板。
📙MT6701 IIC接口电路
- 🔖 第八引脚注意是直接接到VCC,而不是使用电阻上拉。(其内部是有上拉电阻到VCC的)
⛳MT6701 I2C 读取角度操作
MT6701做为I2C从机的地址是b’0000110(这一地址可以通过编程改为b’1000110 )。14位绝对角度数据(2的14次方,16384)保存在0x03和0x04寄存器中,请按照如图-20所示的读取0x03和0x04的角度数据。
注意:要先读0x03,再读0x04。
⛳注意事项
- ✨在MT6701芯片和径向磁铁一定要保持稳定的空间距离,一旦空间距离有较大的变化,在读取MT6701芯片寄存器数据就可能出现最大值情况。在检测时,芯片和径向磁铁轴向和径向都需要相对稳定。
📗读取代码实现部分
//函数:u8 MT6701_ReadOneByte(u8 ReadAddr)
//功能:从MT6701模块读取一个字节的数据
//参数:ReadAddr 要读取的地址
//返回:读取到的数据
static u8 MT6701_ReadOneByte(u8 ReadAddr)
{ u8 temp=0; IIC_Start(); IIC_Send_Byte((0x06<<1)|0x00); //IIC_Wait_Ack(); IIC_Send_Byte(ReadAddr); //IIC_Wait_Ack(); IIC_Start(); IIC_Send_Byte((0x06<<1)|0x01); // IIC_Wait_Ack(); temp=IIC_Read_Byte(0); IIC_Stop();// return temp;
}
//读2个字节数据,获取原始角度
u16 MT6701_ReadTwoByte(u8 higher,u8 lower)
{u16 TwoByte_Data = 0;u16 hi_Data = 0,lo_Data = 0;//Read the first byte (higher address)hi_Data = MT6701_ReadOneByte(higher);//Read the second byte (lower address)lo_Data = MT6701_ReadOneByte(lower);//Combine the two bytes into a single 16-bit valueTwoByte_Data = (uint16_t)(lo_Data>> 2);TwoByte_Data |= ((uint16_t)hi_Data << 6);//Return the 16-bit valuereturn TwoByte_Data;
}
- 📝main函数代码
int main(void)
{u16 i = 0;u16 raw_num = 0;float Angle = 0.0f;u8 addr = 0;u8 ack;u8 read = 0;NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);// 设置中断优先级分组2delay_init(); //延时函数初始化uart_init(115200); //串口初始化为115200printf("MT6701 test\r\n");printf("Scanning I2C bus:\r\n");LED_Init(); //初始化与LED连接的硬件接口IIC_Init();for(addr = 0 ; addr < 255 ; addr++) {IIC_Start();IIC_Send_Byte(addr); //ack = IIC_Wait_Ack();if(ack == 0 && (read % 2 == 0)) {printf("write addr = 0x%x\r\n", addr);read++;} else if(ack == 0 && read % 2 == 1) {printf("read addr = 0x%x\r\n", addr);read++;}IIC_Stop();}//for(i=0x00;i<0xFF;i++)// {// IIC_Start();// IIC_Send_Byte(i);// if(IIC_ACK_Read()==1)// {// printf("%x\r\n",i);// count=1;// }// IIC_Stop();// delay_ms(1);// }// if(count==0) printf("No IIC device found!\r\n");// count=0;while(1) {delay_ms(10);if(++i > 100) {raw_num = MT6701_ReadTwoByte(0x03, 0x04); //读取两个寄存器的值Angle = (float)(raw_num / 16384.0f) * 360.0f ; //对寄存器值进行处理得到角度值printf("MT6701 Raw_num:%d,Angle:%.1f \r\n", raw_num, Angle);LED0 = !LED0; //提示系统正在运行i = 0;}}
}
📚驱动测试代码
链接:https://pan.baidu.com/s/1YRTLFoUJvrdWfcs6dL-qdg?pwd=fsif
提取码:fsif