QMI8610 QMC5883调试记录
2024-05-09 16:04:59
这个芯片复位跟一般芯片不一样，高电平复位，低电平有效。
下面代码接收显示，得到的应该是xyz的磁感强度，还需要自己算法做方位算法校准算法等
qmi8610
//main.cpp
#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <ctype.h>
#include <math.h>
#include <linux/fb.h>
#include <sys/mman.h>
#include <memory.h>
#include "main.h"
// unsigned int Linux_IICNum = 0;//使用海思的那个iic
int Rd_I2C(int Linux_IICNum, unsigned int chipAddr, unsigned int regAddr)
{int retval = 0;int fd = -1, tmp, i;char file_name[0x10];unsigned char buf[4];unsigned int i2c_num, dev_addr, reg_addr, reg_addr_end;unsigned int reg_width = 1, data_width = 1, reg_step = 1;int cur_addr;static struct i2c_rdwr_ioctl_data rdwr;static struct i2c_msg msg[2];unsigned int data;memset(buf, 0x0, 4);i2c_num = Linux_IICNum;dev_addr = chipAddr;reg_addr = regAddr;reg_addr_end = regAddr;dev_addr = dev_addr >> 1;
#ifdef DEBUGprintf("i2c_num:0x%x, dev_addr:0x%x; reg_addr:0x%x; reg_addr_end:0x%x; \reg_width: %d; data_width: %d; reg_step: %d. \n\n",i2c_num, dev_addr << 1, reg_addr, reg_addr_end,reg_width, data_width, reg_step);
#endif // DEBUGsprintf(file_name, "/dev/i2c-%u", i2c_num);fd = open(file_name, O_RDWR);if (fd < 0){printf("Open %s error!\n", file_name);retval = -1;goto end0;}retval = ioctl(fd, I2C_SLAVE_FORCE, dev_addr);if (retval < 0){printf("CMD_SET_I2C_SLAVE error!\n");retval = -1;goto end1;}msg[0].addr = dev_addr;msg[0].flags = 0;msg[0].len = reg_width;msg[0].buf = buf;msg[1].addr = dev_addr;msg[1].flags = 0;msg[1].flags |= I2C_M_RD;msg[1].len = data_width;msg[1].buf = buf;rdwr.msgs = &msg[0];rdwr.nmsgs = (__u32)2;for (cur_addr = reg_addr; cur_addr <= reg_addr_end; cur_addr += reg_step){if (reg_width == 2){buf[0] = (cur_addr >> 8) & 0xff;buf[1] = cur_addr & 0xff;}elsebuf[0] = cur_addr & 0xff;retval = ioctl(fd, I2C_RDWR, &rdwr);if (retval != 2){printf("CMD_I2C_READ error!\n");retval = -1;goto end1;}if (data_width == 2){data = buf[1] | (buf[0] << 8);}elsedata = buf[0];// printf("0x%x: 0x%x\n", cur_addr, data);}retval = data;end1:close(fd);
end0:return retval;
}int Wr_I2C(int Linux_IICNum, unsigned int chipAddr, unsigned int regAddr, unsigned int pData)
{int retval = 0;int fd = -1;int index = 0, tmp, i;char file_name[0x10];unsigned char buf[4];unsigned char i2c_num, dev_addr, reg_addr, data;unsigned int reg_width = 1, data_width = 1;i2c_num = Linux_IICNum;dev_addr = chipAddr;reg_addr = regAddr;data = pData;dev_addr = dev_addr >> 1;
#ifdef DEBUGprintf("i2c_num:0x%x, dev_addr:0x%x; reg_addr:0x%x; data:0x%x; reg_width: %d; data_width: %d.\n",i2c_num, dev_addr << 1, reg_addr, data, reg_width, data_width);
#endifsprintf(file_name, "/dev/i2c-%u", i2c_num);fd = open(file_name, O_RDWR);if (fd < 0){printf("Open %s error!\n", file_name);retval = -1;goto end0;}retval = ioctl(fd, I2C_SLAVE_FORCE, dev_addr);if (retval < 0){printf("set i2c device address error!\n");retval = -1;goto end1;}if (reg_width == 2){buf[index] = (reg_addr >> 8) & 0xff;index++;buf[index] = reg_addr & 0xff;index++;}else{buf[index] = reg_addr & 0xff;index++;}if (data_width == 2){buf[index] = (data >> 8) & 0xff;index++;buf[index] = data & 0xff;index++;}else{buf[index] = data & 0xff;index++;}for (int i = 0; i < 2; i++){retval = write(fd, buf, (reg_width + data_width));if (retval < 0){printf("i2c write error! i2c_num:0x%x, dev_addr:0x%x; reg_addr:0x%x; data:0x%x; reg_width: %d; data_width: %d.\n",i2c_num, dev_addr << 1, reg_addr, data, reg_width, data_width);retval = -1;}else{retval = 0;break;}}
end1:close(fd);
end0:return retval;
}int main(int argc, char *argv[])
{while (1){ unsigned int mxyz[10][3] = {0};unsigned int avermxyz[3] = {0};unsigned int buffer[6] = {0};static float magGaussData[3] = {0.0};static unsigned char cnt = 0;buffer[0]=Rd_I2C(4,0x96,0x19);buffer[1]=Rd_I2C(4,0x96,0x1A);buffer[2]=Rd_I2C(4,0x96,0x1B);buffer[3]=Rd_I2C(4,0x96,0x1C);buffer[4]=Rd_I2C(4,0x96,0x1D);buffer[5]=Rd_I2C(4,0x96,0x1E);printf("Xl=%d,Xh=%d,Yl=%d,Yh=%d,Zl=%d,Zh=%d\r\n", buffer[0], buffer[1], buffer[2], buffer[3], buffer[4], buffer[5]);mxyz[cnt][0] = (int16_t)(buffer[1] << 8 | buffer[0]);mxyz[cnt][1] = (int16_t)(buffer[3] << 8 | buffer[2]);mxyz[cnt][2] = (int16_t)(buffer[5] << 8 | buffer[4]);usleep(1000 * 300);}return 0;
}
qmc5883
#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <ctype.h>
#include <math.h>
#include <linux/fb.h>
#include <sys/mman.h>
#include <memory.h>
#include "main.h"
// unsigned int Linux_IICNum = 0;//使用海思的那个iic
int Rd_I2C(int Linux_IICNum, unsigned int chipAddr, unsigned int regAddr)
{int retval = 0;int fd = -1, tmp, i;char file_name[0x10];unsigned char buf[4];unsigned int i2c_num, dev_addr, reg_addr, reg_addr_end;unsigned int reg_width = 1, data_width = 1, reg_step = 1;int cur_addr;static struct i2c_rdwr_ioctl_data rdwr;static struct i2c_msg msg[2];unsigned int data;memset(buf, 0x0, 4);i2c_num = Linux_IICNum;dev_addr = chipAddr;reg_addr = regAddr;reg_addr_end = regAddr;dev_addr = dev_addr >> 1;
#ifdef DEBUGprintf("i2c_num:0x%x, dev_addr:0x%x; reg_addr:0x%x; reg_addr_end:0x%x; \reg_width: %d; data_width: %d; reg_step: %d. \n\n",i2c_num, dev_addr << 1, reg_addr, reg_addr_end,reg_width, data_width, reg_step);
#endif // DEBUGsprintf(file_name, "/dev/i2c-%u", i2c_num);fd = open(file_name, O_RDWR);if (fd < 0){printf("Open %s error!\n", file_name);retval = -1;goto end0;}retval = ioctl(fd, I2C_SLAVE_FORCE, dev_addr);if (retval < 0){printf("CMD_SET_I2C_SLAVE error!\n");retval = -1;goto end1;}msg[0].addr = dev_addr;msg[0].flags = 0;msg[0].len = reg_width;msg[0].buf = buf;msg[1].addr = dev_addr;msg[1].flags = 0;msg[1].flags |= I2C_M_RD;msg[1].len = data_width;msg[1].buf = buf;rdwr.msgs = &msg[0];rdwr.nmsgs = (__u32)2;for (cur_addr = reg_addr; cur_addr <= reg_addr_end; cur_addr += reg_step){if (reg_width == 2){buf[0] = (cur_addr >> 8) & 0xff;buf[1] = cur_addr & 0xff;}elsebuf[0] = cur_addr & 0xff;retval = ioctl(fd, I2C_RDWR, &rdwr);if (retval != 2){printf("CMD_I2C_READ error!\n");retval = -1;goto end1;}if (data_width == 2){data = buf[1] | (buf[0] << 8);}elsedata = buf[0];// printf("0x%x: 0x%x\n", cur_addr, data);}retval = data;end1:close(fd);
end0:return retval;
}int Wr_I2C(int Linux_IICNum, unsigned int chipAddr, unsigned int regAddr, unsigned int pData)
{int retval = 0;int fd = -1;int index = 0, tmp, i;char file_name[0x10];unsigned char buf[4];unsigned char i2c_num, dev_addr, reg_addr, data;unsigned int reg_width = 1, data_width = 1;i2c_num = Linux_IICNum;dev_addr = chipAddr;reg_addr = regAddr;data = pData;dev_addr = dev_addr >> 1;
#ifdef DEBUGprintf("i2c_num:0x%x, dev_addr:0x%x; reg_addr:0x%x; data:0x%x; reg_width: %d; data_width: %d.\n",i2c_num, dev_addr << 1, reg_addr, data, reg_width, data_width);
#endifsprintf(file_name, "/dev/i2c-%u", i2c_num);fd = open(file_name, O_RDWR);if (fd < 0){printf("Open %s error!\n", file_name);retval = -1;goto end0;}retval = ioctl(fd, I2C_SLAVE_FORCE, dev_addr);if (retval < 0){printf("set i2c device address error!\n");retval = -1;goto end1;}if (reg_width == 2){buf[index] = (reg_addr >> 8) & 0xff;index++;buf[index] = reg_addr & 0xff;index++;}else{buf[index] = reg_addr & 0xff;index++;}if (data_width == 2){buf[index] = (data >> 8) & 0xff;index++;buf[index] = data & 0xff;index++;}else{buf[index] = data & 0xff;index++;}for (int i = 0; i < 2; i++){retval = write(fd, buf, (reg_width + data_width));if (retval < 0){printf("i2c write error! i2c_num:0x%x, dev_addr:0x%x; reg_addr:0x%x; data:0x%x; reg_width: %d; data_width: %d.\n",i2c_num, dev_addr << 1, reg_addr, data, reg_width, data_width);retval = -1;}else{retval = 0;break;}}
end1:close(fd);
end0:return retval;
}int main(int argc, char *argv[])
{Wr_I2C(3, 0x58, 0x0b, 0x00);Wr_I2C(3, 0x58, 0x0a, 0xC3);Wr_I2C(3, 0x58, 0x0d, 0x40);while (1){ unsigned int mxyz[10][3] = {0};unsigned int avermxyz[3] = {0};unsigned int buffer[6] = {0};static float magGaussData[3] = {0.0};static unsigned char cnt = 0;buffer[0]=Rd_I2C(3,0x58,0x01);buffer[1]=Rd_I2C(3,0x58,0x02);buffer[2]=Rd_I2C(3,0x58,0x03);buffer[3]=Rd_I2C(3,0x58,0x04);buffer[4]=Rd_I2C(3,0x58,0x05);buffer[5]=Rd_I2C(3,0x58,0x06);printf("Xl=%d,Xh=%d,Yl=%d,Yh=%d,Zl=%d,Zh=%d\r\n", buffer[0], buffer[1], buffer[2], buffer[3], buffer[4], buffer[5]);mxyz[cnt][0] = (int16_t)(buffer[1] << 8 | buffer[0]);mxyz[cnt][1] = (int16_t)(buffer[3] << 8 | buffer[2]);mxyz[cnt][2] = (int16_t)(buffer[5] << 8 | buffer[4]);cnt++;if (cnt >= 10){cnt = 0;for (unsigned char i = 0, j = 0; i < 3; i++){for (j = 0; j < 10; j++){avermxyz[i] += mxyz[j][i];}avermxyz[i] = avermxyz[i] / 10;}printf("average original data :x=%d,y=%d,z=%d\r\n", avermxyz[0], avermxyz[1], avermxyz[2]);// for (unsigned char k = 0; k < 3; k++)// {// magGaussData[k] = magGaussData[k] - 32768; // 32768:Null Field Output// magGaussData[k] = avermxyz[k] / 3000; // 3000:sensitivity, 3000 counts/G// }// printf("convert the raw data :x=%f,y=%f,z=%f\r\n", magGaussData[0], magGaussData[1], magGaussData[2]);// printf("\r\n");}usleep(1000 * 300);}return 0;
}
QMI8610 QMC5883调试记录相关推荐
- ROS上同时预览depth,IR,RGB 调试记录
ROS上同时预览depth,IR,RGB 调试记录 用rviz同时显示RGB,IR,DEPTH(验证设备:astraprosm,canglong2,deeyea) 1.编译libuvc库 cd lib ...
- ML之回归预测：利用十(xgboost,10-1)种机器学习算法对无人驾驶汽车系统参数(2017年的data,18+2)进行回归预测值VS真实值——bug调试记录
ML之回归预测:利用十(xgboost,10-1)种机器学习算法对无人驾驶汽车系统参数(2017年的data,18+2)进行回归预测值VS真实值--bug调试记录 目录 输出结果 1.增加XGBR算法 ...
- [Deepin - Pycharm调试记录] Pyinstaller索引系统库问题
Deepin - Pycharm调试记录 - Pyinstaller索引不到系统库 现象 在Pycharm的Terminal中执行Pyinstaller指令时候遇到如下报错提示 OSError: Py ...
- RAISR-master：google图像新压缩技术RAISR的测试代码调试记录（Python实现，没接触过python的小白，内含pip install解决方案）
RAISR-master:google图像新压缩技术RAISR的测试代码调试记录(Python实现,没接触过python的小白,内含pip install解决方案) 参考文章: (1)RAISR-ma ...
- SX1278 FSK 调试记录
SX1278 FSK 调试记录 先挖个sx1278 FSK的坑慢慢填 手中有两个SX1278模组 是安信可的产品 采用主从模式 SPI访问 MCU是STM32F107 数据格式 说明收据接收的第一步就 ...
- 松下MINAS-A6伺服电机调试记录
松下MINAS-A6伺服电机调试记录 因项目需求,进行松下MINAS-A6伺服电机调试 文章目录 松下MINAS-A6伺服电机调试记录 概述 一.手册数据 二.设备使用 1.驱动器及电机连接 2.设备 ...
- Xilinx AXI Crossbar相关调试记录
Xilinx AXI Crossbar相关调试记录 本文记录在使用Xilinx AXI Crossbar IPcore现象 ** AXI Crossbar IPcore设置如下** 使用AXI Cro ...
- android pppd参数介绍,android 3G pppd 调试记录
android 3G pppd 调试记录. 1. JAVA 部分 android/development/data/etc/apns-conf_sdk.xml ---> system/e ...
- RV1126 调试记录
RV1126 调试记录 ######################################################################################## ...
最新文章
- java 连接 oracle 10_java 怎么把原本连接32位oracle10g换到连接64位oracle10g
- SQL 语句快速参考
- css 倒三角_改善CSS的10种最佳做法
- Truffle 4.0、Geth 1.7.2、TestRPC在私有链上搭建智能合约
- 英伟达显卡不同架构_英伟达新款笔记本显卡全阵容曝光：共计六款
- loop设备及losetup命令介绍[转]
- python的shelve库
- android之App widget实际应用Demo
- C# 中使用反射的优缺点
- 重磅开源！一款引入实时语音与声纹识别的网络辩论系统！
- 数据库性能优化的五种方案
- 东北师范大学计算机信息技术学院,东北师范大学计算机科学与信息技术学院2015年硕士研究生招生专业目录...
- 把个人网站封装生成百度小程序的方法分享
- 战争军事历史纪录片收集
- CRYPTO进阶版：banana-princess
- 基于Python实现的黑白棋强化学习模型
- web前端学习路线-20个真实web开发项目集合
- CentOS7修改MySQL密码
- linux清除文件后df还是满的,Linux系统下用du和df命令清除大文件的方法
- 微信小程序api基础应用