你的浏览器版本过低，可能导致网站不能正常访问！
为了你能正常使用网站功能，请使用这些浏览器。

st-img
chrome st-img
firefox st-img
safari st-img
ie8及以上

STM32CubeIDE I2C协议采集数据经验分享

[复制链接]
攻城狮Melo 发布时间：2023-4-6 22:05
一、I2C总线协议
       I2C（Inter Integrated Circuit）总线是 PHILIPS 公司开发的一种半双工、双向二线制同步串行总线。I2C 总线传输数据时只需两根信号线，一根是双向数据线 SDA（serial data），另一根是双向时钟线 SCL（serial clock）。SPI 总线有两根线分别用于主从设备之间接收数据和发送数据，而 I2C 总线只使用一根线进行数据收发。I2C 以主从的方式工作，并允许同时有多个主设备存在，每个连接到总线上的器件都有唯一的地址，主设备启动数据传输并产生时钟信号，从设备被主设备寻址，同一时刻只允许有一个主设备。

        I2C 总线主要的数据传输格式：

 da5da8b4846a42e39d99ee8fc8c30231.png

        当总线空闲时，SDA 和 SCL 都处于高电平状态，当主机要和某个从机通讯时，会先发送一个开始条件，然后发送从机地址和读写控制位，接下来传输数据（主机发送或者接收数据），数据传输结束时主机会发送停止条件。传输的每个字节为8位，高位在前，低位在后。

        开始标记：SCL 为高电平时，主机将 SDA 拉低，表示数据传输即将开始；

        从设备地址（或叫从机地址）：主机发送的第一个字节为从机地址，高 7 位为地址，最低位为 R/W 读写控制位，1 表示读操作，0 表示写操作。一般从机地址有 7 位地址模式和 10 位地址模式两种，如果是 10 位地址模式，需要用两个字节（16位）来表述，第一个字节的头 7 位 是 11110XX 的组合，其中最后两位（XX）是 10 位地址的两个最高位，第二个字节为 10 位从机地址的剩下8位：        

 3090a9a70c4447c7981012200dc5a75d.png

         应答： 每传输完成一个字节的数据，接收方就需要回复一个 ACK（acknowledge）。写数据时由从机发送 ACK，读数据时由主机发送 ACK。当主机读到最后一个字节数据时，可发送 NACK（Not acknowledge）然后跟停止条件。

        数据： 从机地址发送完后可能会发送一些指令，依从机而定，然后开始传输数据，由主机或者从机发送，每个数据为 8 位，数据的字节数没有限制。

        重复开始： 在一次通信过程中，主机可能需要和不同的从机传输数据或者需要切换读写操作时，主机可以再发送一个开始条件。

        停止标记： 在 SDA 为低电平时，主机将 SCL 拉高并保持高电平，然后在将 SDA 拉高，表示传输结束。


二、I2C协议的两种从机应对方式
        从机对I2C协议通讯我本人认为提供了两种实现方式：

        寄存器直接访问方式：这种方式是从机直接将其参数、采集数据放置存储区域，并将存储地址暴露给主机，让主机直接按存储地址获取数据，或修改存储地址上的数据，从机感知数据变化做应对处理，从而实现对从机下行控制。我个人管这种方式叫从机地址+寄存器地址。

 804a453636334246acf1f2e4834eb7f7.png

         命令接口间接访问方式：这种方式从机对主机采用问答式服务，不会提供存储地址给主机，只是给出相关指令信息给主机，这些指令相当于从机对外提供的业务接口，例如主机需要读取某个数值，需要先向从机发送读取指令，从机将需要的数据做准备并等待主机下一次指令，主机再去读取数据。我个人管这种方式叫从机地址+CMD指令。

 f03126e25ee045b28a2c5d026dc4dc88.png

         我们再看HLA标准库提供I2C接口API，也支持这两种方式：
  1. //从机地址+CMD
  2. HAL_StatusTypeDef HAL_I2C_Master_Transmit(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData,
  3.                                           uint16_t Size, uint32_t Timeout);
  4. HAL_StatusTypeDef HAL_I2C_Master_Receive(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t *pData,

  6. //从机地址+寄存器地址
  7. HAL_StatusTypeDef HAL_I2C_Mem_Write(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress,
  8.                                     uint16_t MemAddSize, uint8_t *pData, uint16_t Size, uint32_t Timeout);
  9. HAL_StatusTypeDef HAL_I2C_Mem_Read(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint16_t MemAddress,
  10.                                    uint16_t MemAddSize, uint8_t *pData, uint16_t Size, uint32_t Timeout);
复制代码

        PS：I2C在写入和读取时，从机地址是不同的，例如一般“读取从机地址=写入从机地址+1”，在实际使用HAL标准库已经做了内部处理，所以我们就不管读还是写操作，只传入写地址即可，HAL库的读写函数会调用I2C_TransferConfig来完成相关配置，包括从机地址问题，开始条件问题、时钟问题等。
  1. /**
  2.   * @brief  Handles I2Cx communication when starting transfer or during transfer (TC or TCR flag are set).
  3.   * @param  hi2c I2C handle.
  4.   * @param  DevAddress Specifies the slave address to be programmed.
  5.   * @param  Size Specifies the number of bytes to be programmed.
  6.   *   This parameter must be a value between 0 and 255.
  7.   * @param  Mode New state of the I2C START condition generation.
  8.   *   This parameter can be one of the following values:
  9.   *     @arg @ref I2C_RELOAD_MODE Enable Reload mode .
  10.   *     @arg @ref I2C_AUTOEND_MODE Enable Automatic end mode.
  11.   *     @arg @ref I2C_SOFTEND_MODE Enable Software end mode.
  12.   * @param  Request New state of the I2C START condition generation.
  13.   *   This parameter can be one of the following values:
  14.   *     @arg @ref I2C_NO_STARTSTOP Don't Generate stop and start condition.
  15.   *     @arg @ref I2C_GENERATE_STOP Generate stop condition (Size should be set to 0).
  16.   *     @arg @ref I2C_GENERATE_START_READ Generate Restart for read request.
  17.   *     @arg @ref I2C_GENERATE_START_WRITE Generate Restart for write request.
  18.   * @retval None
  19.   */
  20. static void I2C_TransferConfig(I2C_HandleTypeDef *hi2c, uint16_t DevAddress, uint8_t Size, uint32_t Mode,
  21.                                uint32_t Request)
复制代码

三、传感器信息
        本文采用STM32L496VGTX的ali开发板， 该开发板已经连接了以下5个传感器，下图蓝色部分标注的5个传感器就是本文需要实现的（音频、摄像头不仅仅I2C接口，还需要其他接口支持，暂时不在本文展开）：

 401e7506bed647d6916e9193c2e29cbb.png

         这些传感器的硬件原理图如下：
        1）SHTC1温湿度传感器

 ebf61b6dd470406aab6e699d7e460164.png

        2)LTR-553ALS光感及接近传感器，注：它除了I2C支持，还需要一个额外的GPIO引脚

 0ce1e411a3dd485287a6264b7d854cd3.png

         3)BMP280气压传感器

 cf7e61caba7c4bf6a2b5421368342d7d.png

        4） LSM6DSL加速度及角速度传感器

 c3c8cdc80cc34eb2ad97f86446142619.png

        5） MMC3680KJ三轴磁传感器

 e4bc8d4c14d24271a90842414dd4cccf.png

         这些传感器都是通过I2C总线连接到STM32L496VGT3的MCU上，MCU的I2C引脚接口如下：

 25025137dfa844c3863f89fc2be43874.png

5f79efe205bd4e7094d43232984d4212.png

        另外 LTR-553ALS还需要一个GPIO引脚辅助

 2093865e29f94a4f925e5165471ef0e6.png


四、工程创建及引脚配置
        本文新建了一个STM32L496VGTX_I2C工程，并移植了前面已经实现过的串口调试输出及OLED屏幕输出文字的源码

        假设已经基于STM32L496VGTX的MCU上实现了lpusart调试信息输出，和SPI1的oled屏幕显示，接下来配置I2C2和I2C4接口及PA15引脚。

        1）开启I2C2配置，参数保持默认，注意从机地址7bit长度的

 30c1d952bceb406d81cc7aa1e4c4b56c.png

         2）开启I2C2的DMA支持和中断支持（本文代码实现暂时没采用DMA，只是先开启）

 3e71bc0b3d324a888d4f23f05761f6f0.png

205a1b6398624b6da16a5a6fa1f96a54.png

         3）同样开启I2C4接口以及开启其DMA功能和中断功能

 d194a00b8f7d47cdb63ed6fef0f1ad7a.png

         I2C4的DMA及中断功能

 a37d5e4ee030497981caf81d1e850e24.png

1d9110a0665a4bc9a66951200c9d7032.png

        4） I2C2、I2C4引脚参数配置

 ee267eaff44c45ab9b0a645d685d1f6e.png

         5）配置LTR-553ALS传感器需要的PA15引脚，并开启该PA15的中断功能支持

 f8f5ec86ff7a404a9bba2bbc7a6c3c12.png

6183c3549a8d40e8bb2c41610a23cdb4.png

        配置完成后点击保存或生成代码按钮，完成图形配置到代码生产的输出。

五、STCH1传感器实现
        在ICore源码目录下添加STCH1文件夹，并在该文件夹下添加STCH1.h和STCH1.c文件作为STCH1传感器的驱动文件。

        本人去网上下载了一份STCH1传感器的数据手册，读取分析发现采用前面所述的从机地址+CMD指令方式，先明确STCH1的设备地址是0X70，而开发板给出的地址是0XE0，STCH1集成到开发板是经过了微调（0XE0=(0X70<<1）)，那我们采用0XE0就好：

 275a89b433924dcabc4606c9bef30d68.png

        MCU通过I2C协议读取STCH1传感器的温湿度数据需要经历以下几个过程：

        1）STCH1传感器的ID号确认，简单描述就是向STCH1写入两字节的0XEF 0XC8（告诉STCH1我要稍后来读取这个注册地址的数据，请准备好），再读取两个字节数据（16bit）,取0~5bit的数据如果是0X07就表明OK。

 2f71d5ee73054035a2bc0dfd3bb347f4.png

         2）STCH1软重置要求，就是向STCH1写入两字节（16bit）的0X80 0X5D数据即可实现软重置。

 23bf69d1b5104304892d8b46bab37d20.png


         3）STCH1读取数据前，需要明确数据读取组合格式，意思就是I2C开启Clock Stretching时，向STCH1写入16bit的0X7C 0XA2数据，再去读取数据时就是温度数据在前、湿度数据灾后，其他类似，如下图，是否开启Clock Stretching和是否温度在前组合共有四种组合方式。

 b4078ceb2fbe4ee896e45b72fb092c4b.png

         4）下图指出如何读取数据，在告知数据组合方式后，需要读取六字节（6*8 bit）的数据，其中第三和第六字节是CRC数据，剩余的是温湿度数据，第一、第二字节组成一个具体数据，最高有效位(MSB)在前、最低有效位(LSB)在后，第三、第四字节组成一个具体数据，第一、第二字节是温度还是湿度数据，由读取前写入指令确定，详见3）。

 d8dd3d8e38ee484da1e1313975996fd4.png

         5）数据换算到的原数据，需要经过换算公式换算后，才能表示实际的温湿度数值。

 ad848f59ff6f4ac2a742f2c29bd4cdd9.png

         6）伪代码设计：
  1. init:
  2. write 0xef 0xc8 to 0XE0
  3. read  两字节Data     from 0XE0
  4. 取出 Data的0~5位数据与0X07比较完成ID识别
  5. write 0X80, 0X5D to 0XE0 完成重置

  7. read data
  8. write 读取方式指令，例如0X7C 0XA2 to 0XE0
  9. read 六字节Data from 0XE0
  10. Data 1、2字节为温度原始数据，经换算公式获得实际温度值
  11. Data 3、4字节为湿度原始数据，经换算公式获得实际湿度值
复制代码

         7）源码STCH1.h和STCH1.c文件内容如下：

        STCH1.h
  1. #ifndef SHTC1_SHTC1_H_
  2. #define SHTC1_SHTC1_H_

  4. #include "main.h"

  6. void shtc1_init();
  7. uint8_t read_ht(float *cur_humi,float *cur_temp);

  9. #endif /* SHTC1_SHTC1_H_ */
复制代码

         STCH1.c，注意的是由于STCH1传感器采用从机地址+CMD指令方式实现，所以驱动文件调用的是HAL_I2C_Master_Transmit和HAL_I2C_Master_Receive完成I2C数据收发，有别于后面涉及的4种传感器。
  1. #include <stdio.h>
  2. #include "SHTC1.h"

  4. extern I2C_HandleTypeDef hi2c2;

  6. #define SHTC1_I2C_SLAVE_ADDR 0x70

  8. #define SHTC1_ADDR_TRANS(n) ((n) << 1)
  9. #define SHTC1_I2C_ADDR SHTC1_ADDR_TRANS(SHTC1_I2C_SLAVE_ADDR)

  11. /* delays for non-blocking i2c commands, both in ms */
  12. #define SHTC1_NONBLOCKING_WAIT_TIME_HPM 15
  13. #define SHTC1_NONBLOCKING_WAIT_TIME_LPM 1

  15. #define SHTC1_CHIP_ID_VAL 0x07
  16. #define SHTC1_ID_REG_MASK 0x1f

  18. #define SHTC1_CMD_LENGTH 2
  19. #define SHTC1_RESPONSE_LENGTH 6

  21. #define SHTC1_DATA_READ_MIN_INTERVAL 200 /* in millisecond */

  23. typedef enum
  24. {
  25.     FLAG_INIT_TEMP = 0,
  26.     FLAG_INIT_HUMI,
  27. } FLAG_INIT_BIT;

  29. typedef enum
  30. {
  31.     SHTC1_CMD_read_id_reg,
  32.     SHTC1_CMD_measure_blocking_hpm,
  33.     SHTC1_CMD_measure_nonblocking_hpm,
  34.     SHTC1_CMD_measure_blocking_lpm,
  35.     SHTC1_CMD_measure_nonblocking_lpm,
  36.     SHTC1_CMD_END
  37. } CMD_SHTC1_ENUM;

  39. uint8_t SHTC1_id_check()
  40. {
  41.         HAL_StatusTypeDef hi2c2_status = 0x00;
  42.         uint8_t data[SHTC1_CMD_LENGTH] = { 0xef, 0xc8 };
  43.         hi2c2_status = HAL_I2C_Master_Transmit(&hi2c2,SHTC1_I2C_ADDR,data,SHTC1_CMD_LENGTH,1000);
  44.         if(HAL_OK!=hi2c2_status){
  45.                 printf("set SHTC1_id error\r\n");
  46.                 return 1;
  47.         }
  48.         uint8_t value[2] = { 0 };
  49.         hi2c2_status = HAL_I2C_Master_Receive(&hi2c2,SHTC1_I2C_ADDR,value,2,1000);
  50.         if(HAL_OK!=hi2c2_status){
  51.                 printf("get SHTC1_id error\r\n");
  52.                 return 1;
  53.         }
  54.         printf("SHTC1_id:0X%02X%02X\r\n",value[0],value[1]);
  55.         //SHTC1_ID_REG_MASK=0X1F,SHTC1_CHIP_ID_VAL=0X07
  56.         if ((value[1] & SHTC1_ID_REG_MASK) != SHTC1_CHIP_ID_VAL) {
  57.         return 1;
  58.     }
  59.         printf("SHTC1_id check successfully\r\n");
  60.         return 0;
  61. }
  62. //软重置
  63. void reSet()
  64. {
  65.         HAL_StatusTypeDef hi2c2_status = 0x00;
  66.     uint8_t temp[2] = {0X80, 0X5D};
  67.     hi2c2_status = HAL_I2C_Master_Transmit(&hi2c2,SHTC1_I2C_ADDR,temp,2,1000);
  68.     if(HAL_OK!=hi2c2_status){
  69.                 printf("SHTC1 reset error\r\n");
  70.                 return;
  71.         }
  72.     printf("SHTC1 reSet successfully\r\n");
  73. }

  75. /*SHTC1提供了定义测量期间的传感器行为以及测量结果的传输序列的可能性。
  76. *每个测量命令都会同时触发温度测量和湿度测量。
  77. *bool enabled时钟是否启用，bool humi是否在前*/
  78. void clock_set(uint8_t enabled,uint8_t humi)
  79. {
  80.     uint8_t temp[2] = {0, 0};
  81.     if(enabled){
  82.         /*时钟拉伸 已启用*/
  83.         if(humi){
  84.             /*湿度、温度*/
  85.             temp[0] = 0x5C;
  86.             temp[1] = 0x24;
  87.         }else{
  88.             /*温度、湿度*/
  89.             temp[0] = 0x7C;
  90.             temp[1] = 0xA2;
  91.         }
  92.     }else{
  93.         /*时钟拉伸 丧失能力的*/
  94.         if(humi){
  95.             /*湿度、温度*/
  96.             temp[0] = 0x58;
  97.             temp[1] = 0xE0;
  98.         }else{
  99.             /*温度、湿度*/
  100.             temp[0] = 0x78;
  101.             temp[1] = 0x66;
  102.         }
  103.     }
  104.     printf("out model:");
  105.     for(uint8_t i=0; i<2; i++ )
  106.     {
  107.         printf("%02X ", temp[i]);
  108.     }
  109.     printf("\n");
  110.     HAL_I2C_Master_Transmit(&hi2c2,SHTC1_I2C_ADDR,temp,2,1000);
  111. }

  113. void shtc1_init()
  114. {
  115.         SHTC1_id_check();
  116.     reSet();
  117.     HAL_Delay(1000);
  118.     /*温度在前*/
  119.     clock_set(1,0);
  120.     HAL_Delay(1000);
  121. }

  123. uint8_t read_ht(float *cur_humi,float *cur_temp)
  124. {
  125.         /* 1、先发送要读取确认 */
  126.         clock_set(1,0);/*时钟拉伸 已启用 && 温度、湿度->0X7C 0XA2*/
  127.         /* 2、读取数据 */;
  128.         HAL_StatusTypeDef hi2c2_status = 0x00;
  129.         uint8_t retval[SHTC1_RESPONSE_LENGTH] = {0x00};
  130.         hi2c2_status = HAL_I2C_Master_Receive(&hi2c2, SHTC1_I2C_ADDR, retval, 6, 1000);
  131.         if(HAL_OK!=hi2c2_status)
  132.                 return 1;
  133.         else{
  134.             uint32_t val01 = (retval[0] << 8 | retval[1]);
  135.             uint32_t val02 = (retval[3] << 8 | retval[4]);
  136.             printf("val01:%d,val02:%d\n",(int)val01,(int)val02);
  137.             /* 温度数据转换 */
  138.             *cur_temp =  val01 * 175.0 / (1 << 16) - 45;
  139.             //*cur_temp = (int32_t)((21875 * val01) >> 13) - 45000;//千位表示
  140.             /* 湿度数据转换 */
  141.             *cur_humi = val02 * 100.0 / (1 << 16);
  142.             //*cur_humi = (uint32_t)((12500 * val02) >> 13);
  143.             //lpusart
  144.             printf("\nread shtc1 sensor humidity   : %d.%d\n", (int)(*cur_humi), (int)((*cur_humi) * 100) % 100);
  145.             if( (*cur_temp) >= 0 )
  146.                 {
  147.                     printf("read shtc1 sensor temperature: %d.%d\n", (int)(*cur_temp), (int)((*cur_temp) * 100) % 100);
  148.                 }else{
  149.                         printf("read shtc1 sensor temperature: %d.%d\n", (int)(*cur_temp), (int)(-(*cur_temp) * 100) % 100);
  150.             }
  151.                 return 0;
  152.         }
  153. }
复制代码

六、LTR_553ALS传感器（light sensor [ALS] and proximity sensor）
        在ICore目录下，创建LTR-553ALS-WA文件夹，并在该文件夹下创建LTR-553ALS-WA.h和LTR-553ALS-WA.c源码文件，作为LTR-553ALS传感器驱动。

        本人在网上下载了一份LTR-553ALS-WA的数据手册文档，进行分析其实是我们前面所述的从机地址+寄存器地址方式来实现的，那么主要就是分析寄存器地址及相关含义即可，从机地址如下（0X46=0X23<<1）,显然开发板做了调整：

 8c8b7287ff6d4dbe961c275013f38282.png

        1）先看LTR-553ALS的I2C通信格式，下图是写入通信，典型从机地址（Slave address）+寄存器地址（Register Address）方式+写入数据（Register Command）。

 052932afb9f04274a0267bab8666421c.png

         读通信方式，类似写入方式。

 0bdee956626e4c7c823cb1d87aebb2eb.png
1cc1bd9f2aae40bbbe4d8aa5fc400f0f.png

         2）下图是LTR-553ALS-WA的总寄存器地址描述表，可以看出0X80是ALS（光感应）的模式控制、重置的功能地址，OX81是PS（接近感应）的模式控制，0X82是PS_LED取值地址，0X84、0X85是ALS、PS的激活地址，0X86、0X87是设备的ID验证地址，0X88、0X89、0X8A、0X8B是ALS 数值存储地址，0X8D、0X8E是PS数值存储地址。

 c05a3028a1844744bac9f405885cfa5d.png

         3）设备ID验证，就是读取0X86的PART_ID数据，正确返回值是0X92，读取0X87的manufac_id数据，正确返回值是0X05.

 c8a48a7548a44609af3798d87874eed3.png

         4）ALS的启用，主要：1.就是向0X85写入激活mode。设置检测time 和 rate，

 708e022e76ca48628e376fe482ff3938.png

                 2.向0X80写入contr mode，开启或关闭ACTIVE，如果想保留原来设置，可先读取oldconf，再oldconf&需要的设值，重新写入实现增加或删减支持模式,0X80还支持 software reset.

 ba09502e9bf54dca979fedf8a3f7ecae.png

        5)PS的启用，类似于ALS设置，0X84开启Meas Rate激活PS，具体功能支持参考一下图。



         向0X81写入数据设置contr mode，开启或关闭ACTIVE

 0aab3728925b40cabd09fd67482f7818.png

         6）ALS数据读取，最低有效位在前，0X88、0X89读取通道1(ch1)数据

 0dbd4e6457074aa08e0f26b3f7f8559b.png

         0X8A、0X8B读取通道0(ch0)数据

 353623b684a44a8689dcdc1814af79be.png

         7）读取PS数据，访问0X8D、0X8E地址，最低有效位在前。

 60e90e31c94448e8911c6d1676eb6c44.png

         8）读取ALS（光感应）、PS（接近感应）数据伪代码实现：
  1. 从机地址是0x46
  2. Init：
  3. read data1 from 从机0x46 寄存地址 0X86
  4. read data2 from 从机0x46 寄存地址 0X87
  5. 确保data1=0x92,data2=0x05

  7. ALS init
  8. write 设值 to 从机0x46 寄存地址 0X85 设置Measure Time and Rate
  9. write 设值 to 从机0x46 寄存地址 0X80 设置 Active

  11. PS init
  12. write 设值 to 从机0x46 寄存地址 0X84 设置Measure Rate
  13. write 设值 to 从机0x46 寄存地址 0X81 设置 Active

  15. 读取数据

  17. ALS read 前提确保0X80 设置 Active开启
  18. read data1~4 from 从机0x46 寄存地址 0X88 0X89 0X8A 0X8B
  19. 对data1~4数据进行换算处理

  21. PS read 前提确保0X81 设置 Active开启
  22. read data1~2 from 从机0x46 寄存地址 0X8D 0X8E
  23. 对data1~2数据进行换算处理
复制代码

        9）LTR-553ALS传感器驱动具体代码，见LTR-553ALS-WA.h和LTR-553ALS-WA.c文件
  1. #ifndef _LTR_553ALS_WA_H_
  2. #define _LTR_553ALS_WA_H_

  4. #include "main.h"

  6. void LTR_ALS_init();
  7. void LTR_PS_init();

  9. uint8_t ltr553_als_open();
  10. uint8_t ltr553_als_close();

  12. uint8_t ltr553_ps_open();
  13. uint8_t ltr553_ps_close();

  15. uint8_t read_als(uint32_t *als_data);
  16. uint8_t read_ps(uint32_t *ps_data);

  18. #endif /* LTR_553ALS_WA_LTR_553ALS_WA_H_ */
复制代码

         LTR-553ALS-WA.c，由于是从机地址+寄存器地址方式，驱动文件调用了HAL标准库的HAL_I2C_Mem_Write和HAL_I2C_Mem_Read函数实现I2C收发。
  1. #include <stdio.h>
  2. #include "LTR-553ALS-WA.h"

  4. #define WAIT_FOREVER 0xffffffffu

  6. extern I2C_HandleTypeDef hi2c2;

  8. #define LTR553_ALS_CONTR 0x80 /* ALS operation mode, SW reset */
  9. #define LTR553_PS_CONTR 0x81  /* PS operation mode */
  10. #define LTR553_PS_LED 0x82    /* LED pulse freq, current duty, peak current */
  11. #define LTR553_PS_MEAS_RATE 0x84  /* measurement rate*/
  12. #define LTR553_ALS_MEAS_RATE 0x85 /* ALS integ time, measurement rate*/
  13. #define LTR553_PART_ID 0x86
  14. #define LTR553_MANUFAC_ID 0x87
  15. #define LTR553_ALS_DATA1_L 0x88
  16. #define LTR553_ALS_DATA1_H 0x89
  17. #define LTR553_ALS_DATA0_L 0x8a
  18. #define LTR553_ALS_DATA0_H 0x8b
  19. #define LTR553_ALS_PS_STATUS 0x8c
  20. #define LTR553_PS_DATA_L 0x8d
  21. #define LTR553_PS_DATA_H 0x8e
  22. #define LTR553_INTR 0x8f           /* output mode, polarity, mode */
  23. #define LTR553_PS_THRESH_UP 0x90   /* 11 bit, ps upper threshold */
  24. #define LTR553_PS_THRESH_LOW 0x92  /* 11 bit, ps lower threshold */
  25. #define LTR553_ALS_THRESH_UP 0x97  /* 16 bit, ALS upper threshold */
  26. #define LTR553_ALS_THRESH_LOW 0x99 /* 16 bit, ALS lower threshold */
  27. #define LTR553_INTR_PRST 0x9e      /* ps thresh, als thresh */
  28. #define LTR553_MAX_REG 0x9f

  30. #define LTR553_I2C_SLAVE_ADDR 0x23

  32. #define LTR553_ADDR_TRANS(n) ((n) << 1)
  33. #define LTR553_I2C_ADDR LTR553_ADDR_TRANS(LTR553_I2C_SLAVE_ADDR)
  34. #define LTR553_PART_ID_VAL 0x92
  35. #define LTR553_MANUFAC_ID_VAL 0x05

  37. #define LTR553_ALS_CONTR_REG_ALS_GAIN__POS (2)
  38. #define LTR553_ALS_CONTR_REG_ALS_GAIN__MSK (0x1c)
  39. #define LTR553_ALS_CONTR_REG_ALS_GAIN__REG (LTR553_ALS_CONTR)

  41. #define LTR553_ALS_CONTR_REG_ALS_MODE__POS (0)
  42. #define LTR553_ALS_CONTR_REG_ALS_MODE__MSK (0x01)
  43. #define LTR553_ALS_CONTR_REG_ALS_MODE__REG (LTR553_ALS_CONTR)

  45. #define LTR553_ALS_MEAS_RATE_REG_INTEG_TIME__POS (3)
  46. #define LTR553_ALS_MEAS_RATE_REG_INTEG_TIME__MSK (0x38)
  47. #define LTR553_ALS_MEAS_RATE_REG_INTEG_TIME__REG (LTR553_ALS_MEAS_RATE)

  49. #define LTR553_ALS_MEAS_RATE_REG_MEAS_RATE__POS (0)
  50. #define LTR553_ALS_MEAS_RATE_REG_MEAS_RATE__MSK (0x07)
  51. #define LTR553_ALS_MEAS_RATE_REG_MEAS_RATE__REG (LTR553_ALS_MEAS_RATE)

  53. #define LTR553_ALS_PS_STATUS_REG_ALS_STATUS__POS (2)
  54. #define LTR553_ALS_PS_STATUS_REG_ALS_STATUS__MSK (0x04)
  55. #define LTR553_ALS_PS_STATUS_REG_ALS_STATUS__REG (LTR553_ALS_PS_STATUS)

  57. #define LTR553_PS_CONTR_REG_PS_GAIN__POS (2)
  58. #define LTR553_PS_CONTR_REG_PS_GAIN__MSK (0x0c)
  59. #define LTR553_PS_CONTR_REG_PS_GAIN__REG (LTR553_PS_CONTR)

  61. #define LTR553_PS_CONTR_REG_PS_MODE__POS (0)
  62. #define LTR553_PS_CONTR_REG_PS_MODE__MSK (0x03)
  63. #define LTR553_PS_CONTR_REG_PS_MODE__REG (LTR553_PS_CONTR)

  65. #define LTR553_PS_LED_REG_PLUSE_FREQ__POS (5)
  66. #define LTR553_PS_LED_REG_PLUSE_FREQ__MSK (0xe0)
  67. #define LTR553_PS_LED_REG_PLUSE_FREQ__REG (LTR553_PS_LED)

  69. #define LTR553_PS_LED_REG_CURRENT_DUTY__POS (3)
  70. #define LTR553_PS_LED_REG_CURRENT_DUTY__MSK (0x18)
  71. #define LTR553_PS_LED_REG_CURRENT_DUTY__REG (LTR553_PS_LED)

  73. #define LTR553_PS_LED_REG_CURRENT__POS (0)
  74. #define LTR553_PS_LED_REG_CURRENT__MSK (0x07)
  75. #define LTR553_PS_LED_REG_CURRENT__REG (LTR553_PS_LED)

  77. #define LTR553_PS_MEAS_RATE_REG_MEAS_RATE__POS (0)
  78. #define LTR553_PS_MEAS_RATE_REG_MEAS_RATE__MSK (0x0F)
  79. #define LTR553_PS_MEAS_RATE_REG_MEAS_RATE__REG (LTR553_PS_MEAS_RATE)

  81. #define LTR553_ALS_PS_STATUS_REG_PS_STATUS__POS (0)
  82. #define LTR553_ALS_PS_STATUS_REG_PS_STATUS__MSK (0x01)
  83. #define LTR553_ALS_PS_STATUS_REG_PS_STATUS__REG (LTR553_ALS_PS_STATUS)

  85. #define LTR553_GET_BITSLICE(regvar, bitname) \
  86.     ((regvar & bitname##__MSK) >> bitname##__POS)
  87. #define LTR553_SET_BITSLICE(regvar, bitname, val) \
  88.     ((regvar & ~bitname##__MSK) | ((val << bitname##__POS) & bitname##__MSK))

  90. #define LTR553_WAIT_TIME_PER_CHECK (10)
  91. #define LTR553_WAIT_TIME_TOTAL (1000)

  93. typedef enum
  94. {
  95.     AG_GAIN_1X  = 0x0, /* 1 lux to 64k lux (default) */
  96.     AG_GAIN_2X  = 0x1, /* 0.5 lux to 32k lux */
  97.     AG_GAIN_4X  = 0x2, /* 0.25 lux to 16k lux */
  98.     AG_GAIN_8X  = 0x3, /* 0.125 lux to 8k lux */
  99.     AG_GAIN_48X = 0x6, /* 0.02 lux to 1.3k lux */
  100.     AG_GAIN_96X = 0x7, /* 0.01 lux to 600 lux */
  101. } CFG_ALS_Gain;

  103. typedef enum
  104. {
  105.     PG_GAIN_X16 = 0x0, /* X16 (default) */
  106.     PG_GAIN_X32 = 0x2, /* X32 */
  107.     PG_GAIN_X64 = 0x3, /* X64 */
  108. } CFG_PS_Gain;

  110. typedef enum
  111. {
  112.     LPMF_PERIOD_30K  = 0x0, /* LED pulse period = 30kHz */
  113.     LPMF_PERIOD_40K  = 0x1, /* LED pulse period = 40kHz */
  114.     LPMF_PERIOD_50K  = 0x2, /* LED pulse period = 50kHz */
  115.     LPMF_PERIOD_60K  = 0x3, /* LED pulse period = 60kHz(default) */
  116.     LPMF_PERIOD_70K  = 0x4, /* LED pulse period = 70kHz */
  117.     LPMF_PERIOD_80K  = 0x5, /* LED pulse period = 80kHz */
  118.     LPMF_PERIOD_90K  = 0x6, /* LED pulse period = 90kHz */
  119.     LPMF_PERIOD_100K = 0x7, /* LED pulse period = 100kHz */
  120. } CFG_LED_pulse_Modulation_Frequency;

  122. typedef enum
  123. {
  124.     LCD_PER_25  = 0x0, /* DUTY = 25% */
  125.     LCD_PER_50  = 0x1, /* DUTY = 50% */
  126.     LCD_PER_75  = 0x2, /* DUTY = 75% */
  127.     LCD_PER_100 = 0x3, /* DUTY = 100%(default) */
  128. } CFG_LED_Current_DUTY;

  130. typedef enum
  131. {
  132.     LC_LEVEL_5   = 0x0, /* LED pulse current level = 5mA */
  133.     LC_LEVEL_10  = 0x1, /* LED pulse current level = 10mA */
  134.     LC_LEVEL_20  = 0x2, /* LED pulse current level = 20mA */
  135.     LC_LEVEL_50  = 0x3, /* LED pulse current level = 50mA */
  136.     LC_LEVEL_100 = 0x4, /* LED pulse current level = 100mA(default) */
  137. } CFG_LED_Current;

  139. typedef enum
  140. {
  141.     PMR_RATE_50   = 0x0, /* PS Measurement Repeat Rate = 50ms */
  142.     PMR_RATE_70   = 0x1, /* PS Measurement Repeat Rate = 70ms */
  143.     PMR_RATE_100  = 0x2, /* PS Measurement Repeat Rate = 100ms(default) */
  144.     PMR_RATE_200  = 0x3, /* PS Measurement Repeat Rate = 200ms */
  145.     PMR_RATE_500  = 0x4, /* PS Measurement Repeat Rate = 500ms */
  146.     PMR_RATE_1000 = 0x5, /* PS Measurement Repeat Rate = 1000ms */
  147.     PMR_RATE_2000 = 0x6, /* PS Measurement Repeat Rate = 2000ms */
  148.     PMR_RATE_10   = 0x8, /* PS Measurement Repeat Rate = 10ms */
  149. } CFG_PS_measurement_rate;

  151. typedef enum
  152. {
  153.     AIT_TIME_100 = 0x0, /* ALS integration_time = 100ms(default) */
  154.     AIT_TIME_50  = 0x1, /* ALS integration_time = 50ms */
  155.     AIT_TIME_200 = 0x2, /* ALS integration_time = 200ms */
  156.     AIT_TIME_400 = 0x3, /* ALS integration_time = 400ms */
  157.     AIT_TIME_150 = 0x4, /* ALS integration_time = 150ms */
  158.     AIT_TIME_250 = 0x5, /* ALS integration_time = 250ms */
  159.     AIT_TIME_300 = 0x6, /* ALS integration_time = 300ms */
  160.     AIT_TIME_350 = 0x7, /* ALS integration_time = 350ms */
  161. } CFG_ALS_integration_time;

  163. typedef enum
  164. {
  165.     AMR_RATE_50   = 0x0, /* ALS Measurement Repeat Rate = 50ms */
  166.     AMR_RATE_100  = 0x1, /* ALS Measurement Repeat Rate = 100ms */
  167.     AMR_RATE_200  = 0x2, /* ALS Measurement Repeat Rate = 200ms */
  168.     AMR_RATE_500  = 0x3, /* ALS Measurement Repeat Rate = 500ms(default) */
  169.     AMR_RATE_1000 = 0x4, /* ALS Measurement Repeat Rate = 1000ms */
  170.     AMR_RATE_2000 = 0x5, /* ALS Measurement Repeat Rate = 2000ms */
  171. } CFG_ALS_measurement_rate;

  173. typedef enum
  174. {
  175.     PM_MODE_STANDBY = 0,
  176.     PM_MODE_ACTIVE  = 3,
  177. } CFG_PS_mode;

  179. typedef enum
  180. {
  181.     AM_MODE_STANDBY = 0,
  182.     AM_MODE_ACTIVE  = 1,
  183. } CFG_ALS_mode;

  185. typedef enum
  186. {
  187.     ADS_STATUS_OLD = 0,
  188.     ADS_STATUS_NEW = 1,
  189. } CFG_ALS_data_status;

  191. typedef enum
  192. {
  193.     PDS_STATUS_OLD = 0,
  194.     PDS_STATUS_NEW = 1,
  195. } CFG_PS_data_status;

  197. typedef enum
  198. {
  199.     FLAG_INIT_ALS = 0,
  200.     FLAG_INIT_PS,
  201. } FLAG_INIT_BIT;

  203. typedef enum {
  204.     DEV_POWER_OFF = 0,
  205.     DEV_POWER_ON,
  206.     DEV_SLEEP,
  207.     DEV_SUSPEND,
  208.     DEV_DEEP_SUSPEND,
  209. } LTR_power_mode;

  211. uint8_t LTR553_id_check()
  212. {
  213.         HAL_StatusTypeDef hi2c2_status = 0x00;
  214.         /*ID check*/
  215.         //LTR553_PART_ID=0X86,LTR553_MANUFAC_ID=0X87
  216.         //LTR553_PART_ID_VAL=0X92,LTR553_MANUFAC_ID_VAL=0X05
  217.         uint8_t id_addr_val[6] = {LTR553_PART_ID,LTR553_PART_ID_VAL,0x00,LTR553_MANUFAC_ID,LTR553_MANUFAC_ID_VAL,0x00};
  218.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,id_addr_val[0],1,&id_addr_val[2],1,1000);
  219.         if(HAL_OK!=hi2c2_status){
  220.                 printf("get part_id error\r\n");
  221.                 return 1;
  222.         }
  223.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,id_addr_val[3],1,&id_addr_val[5],1,1000);
  224.         if(HAL_OK!=hi2c2_status){
  225.                 printf("get manufac_id error\r\n");
  226.                 return 1;
  227.         }
  228.         if(id_addr_val[1]!=id_addr_val[2]||id_addr_val[4]!=id_addr_val[5]){
  229.                 printf("drv_als_ps_liteon_ltr553_validate_id is error\r\n");
  230.                 return 1;
  231.         }
  232.         printf("part_id:%02X,manufac_id:%02X\r\n",id_addr_val[2],id_addr_val[5]);
  233.         return 0;
  234. }

  236. uint8_t ltr553_als_set_power_mode(LTR_power_mode mode)
  237. {
  238.         HAL_StatusTypeDef hi2c2_status = 0x00;
  239.         uint8_t dev_mode  = 0;
  240.         uint8_t value     = 0;

  242.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,LTR553_ALS_CONTR,1,&value,1,WAIT_FOREVER);
  243.         if(HAL_OK!=hi2c2_status){
  244.                 printf("get als_contr error\r\n");
  245.                 return 1;
  246.         }
  247.         printf("ALS_CONTR old:%02X\r\n",value);
  248.     switch (mode) {
  249.         case DEV_POWER_OFF:
  250.         case DEV_SLEEP:
  251.             dev_mode = LTR553_SET_BITSLICE(dev_mode, LTR553_ALS_CONTR_REG_ALS_MODE, AM_MODE_STANDBY);
  252.             break;
  253.         case DEV_POWER_ON:
  254.             dev_mode = LTR553_SET_BITSLICE(dev_mode, LTR553_ALS_CONTR_REG_ALS_MODE, AM_MODE_ACTIVE);
  255.             break;
  256.         default:
  257.             return 1;
  258.     }
  259.     printf("ALS_CONTR new:%02X\r\n",dev_mode);
  260.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,LTR553_I2C_ADDR,LTR553_ALS_CONTR,1,&dev_mode,1,WAIT_FOREVER);
  261.         if(HAL_OK!=hi2c2_status){
  262.                 printf("set ALS_CONTR error\r\n");
  263.                 return 1;
  264.         }
  265.         printf("successfully LTR553_ALS set_power_mode!\r\n");
  266.     return 0;
  267. }

  269. uint8_t ltr553_ps_set_power_mode(LTR_power_mode mode)
  270. {
  271.         HAL_StatusTypeDef hi2c2_status = 0x00;
  272.         uint8_t dev_mode  = 0;
  273.         uint8_t value     = 0;

  275.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,LTR553_PS_CONTR,1,&value,1,WAIT_FOREVER);
  276.         if(HAL_OK!=hi2c2_status){
  277.                 printf("get ps_contr error\r\n");
  278.                 return 1;
  279.         }
  280.         printf("PS_CONTR old:%02X\r\n",value);
  281.     switch (mode) {
  282.         case DEV_POWER_OFF:
  283.         case DEV_SLEEP:
  284.             dev_mode = LTR553_SET_BITSLICE(value, LTR553_PS_CONTR_REG_PS_MODE,PM_MODE_STANDBY);
  285.             break;
  286.         case DEV_POWER_ON:
  287.             dev_mode = LTR553_SET_BITSLICE(value, LTR553_PS_CONTR_REG_PS_MODE,PM_MODE_ACTIVE);
  288.             break;
  289.         default:
  290.             return 1;
  291.     }
  292.     printf("ALS_CONTR new:%02X\r\n",dev_mode);
  293.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,LTR553_I2C_ADDR,LTR553_PS_CONTR,1,&dev_mode,1,WAIT_FOREVER);
  294.         if(HAL_OK!=hi2c2_status){
  295.                 printf("set PS_CONTR error\r\n");
  296.                 return 1;
  297.         }
  298.         printf("successfully LTR553_PS set_power_mode!\r\n");
  299.     return 0;
  300. }

  302. uint8_t ltr553_als_is_ready()
  303. {
  304.         HAL_StatusTypeDef hi2c2_status = 0x00;
  305.         uint8_t value = 0;
  306.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,LTR553_ALS_PS_STATUS,1,&value,1,WAIT_FOREVER);
  307.         if(HAL_OK!=hi2c2_status){
  308.                 printf("get ps_contr error\r\n");
  309.                 return 0;
  310.         }
  311. //        printf("PS_CONTR old:%02X\r\n",value);
  312.         uint8_t ret = (LTR553_GET_BITSLICE(value, LTR553_ALS_PS_STATUS_REG_ALS_STATUS) == ADS_STATUS_NEW)? 1 : 0;
  313.         return ret;
  314. }

  316. uint8_t ltr553_ps_is_ready()
  317. {
  318.         HAL_StatusTypeDef hi2c2_status = 0x00;
  319.         uint8_t value = 0;
  320.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,LTR553_ALS_PS_STATUS,1,&value,1,WAIT_FOREVER);
  321.         if(HAL_OK!=hi2c2_status){
  322.                 printf("get ps_contr error\r\n");
  323.                 return 0;
  324.         }
  325. //        printf("PS_CONTR old:%02X\r\n",value);
  326.         uint8_t ret = (LTR553_GET_BITSLICE(value, LTR553_ALS_PS_STATUS_REG_PS_STATUS) == PDS_STATUS_NEW)? 1 : 0;
  327.         return ret;
  328. }

  330. uint8_t ltr553_als_set_default_config()
  331. {
  332.         HAL_StatusTypeDef hi2c2_status = 0x00;
  333.         uint8_t value = 0;
  334.         value = LTR553_SET_BITSLICE(value, LTR553_ALS_MEAS_RATE_REG_INTEG_TIME,AIT_TIME_100);
  335.         value = LTR553_SET_BITSLICE(value, LTR553_ALS_MEAS_RATE_REG_MEAS_RATE,AMR_RATE_100);
  336.         printf("ALS_MEAS_RATE:%02X\r\n",value);
  337.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,LTR553_I2C_ADDR,LTR553_ALS_MEAS_RATE,1,&value,1,WAIT_FOREVER);
  338.         if(HAL_OK!=hi2c2_status){
  339.                 printf("set ALS_MEAS_RATE error\r\n");
  340.                 return 1;
  341.         }
  342.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,LTR553_ALS_CONTR,1,&value,1,WAIT_FOREVER);
  343.         if(HAL_OK!=hi2c2_status){
  344.                 printf("get als_contr error\r\n");
  345.                 return 1;
  346.         }
  347.         printf("ALS_CONTR old:%02X\r\n",value);
  348.         value =        LTR553_SET_BITSLICE(value, LTR553_ALS_CONTR_REG_ALS_GAIN, AG_GAIN_1X);
  349.         printf("ALS_CONTR new:%02X\r\n",value);
  350.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,LTR553_I2C_ADDR,LTR553_ALS_CONTR,1,&value,1,WAIT_FOREVER);
  351.         if(HAL_OK!=hi2c2_status){
  352.                 printf("get ALS_CONTR error\r\n");
  353.                 return 1;
  354.         }
  355.         printf("successfully LTR553_ALS_default_config!\r\n");
  356.         return 0;
  357. }

  359. uint8_t ltr553_ps_set_default_config()
  360. {
  361.         HAL_StatusTypeDef hi2c2_status = 0x00;
  362.         //LTR553_PS_MEAS_RATE=0X84,LTR553_PS_LED=0X82,LTR553_PS_CONTR=0X81
  363.         uint8_t value = 0;
  364.         value = LTR553_SET_BITSLICE(value, LTR553_PS_MEAS_RATE_REG_MEAS_RATE,PMR_RATE_100);
  365.         printf("PS_MEAS_RATE:%02X\r\n",value);
  366.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,LTR553_I2C_ADDR,LTR553_PS_MEAS_RATE,1,&value,1,1000);
  367.         if(HAL_OK!=hi2c2_status){
  368.                 printf("set PS_MEAS_RATE error\r\n");
  369.                 return 1;
  370.         }
  371.         //value default 0X7F
  372.         value = LTR553_SET_BITSLICE(value, LTR553_PS_LED_REG_PLUSE_FREQ, LPMF_PERIOD_60K);
  373.         value = LTR553_SET_BITSLICE(value, LTR553_PS_LED_REG_CURRENT_DUTY, LCD_PER_100);
  374.         value = LTR553_SET_BITSLICE(value, LTR553_PS_LED_REG_CURRENT, LC_LEVEL_100);
  375.         printf("PS_LED:%02X\r\n",value);
  376.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,LTR553_I2C_ADDR,LTR553_PS_MEAS_RATE,1,&value,1,1000);
  377.         if(HAL_OK!=hi2c2_status){
  378.                 printf("get PS_LED error\r\n");
  379.                 return 1;
  380.         }
  381.         //check
  382.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,LTR553_PS_CONTR,1,&value,1,WAIT_FOREVER);
  383.         if(HAL_OK!=hi2c2_status){
  384.                 printf("get ps_contr error\r\n");
  385.                 return 1;
  386.         }
  387.         printf("PS_CONTR old:%02X\r\n",value);
  388.         value = LTR553_SET_BITSLICE(value, LTR553_PS_CONTR_REG_PS_GAIN, PG_GAIN_X16);
  389.         printf("PS_CONTR new:%02X\r\n",value);
  390.         //
  391.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,LTR553_I2C_ADDR,LTR553_PS_CONTR,1,&value,1,1000);
  392.         if(HAL_OK!=hi2c2_status){
  393.                 printf("get PS_CONTR error\r\n");
  394.                 return 1;
  395.         }
  396.         printf("successfully LTR553_PS default_config!\r\n");
  397.         return 0;
  398. }

  400. uint8_t ltr553_als_open()
  401. {
  402.         uint8_t ret = 0;

  404.         ret = ltr553_als_set_power_mode(DEV_POWER_ON);
  405.     if (ret>0) {
  406.         return 1;
  407.     }
  408.     printf("successfully LTR553_ALS Open!\r\n");
  409.     return 0;
  410. }

  412. uint8_t ltr553_als_close()
  413. {
  414.         uint8_t ret = 0;

  416.         ret = ltr553_als_set_power_mode(DEV_POWER_OFF);
  417.     if (ret>0) {
  418.         return 1;
  419.     }
  420.     printf("successfully LTR553_ALS Close!\r\n");
  421.     return 0;
  422. }

  424. uint8_t ltr553_ps_open()
  425. {
  426.         uint8_t ret = 0;

  428.         ret = ltr553_ps_set_power_mode(DEV_POWER_ON);
  429.     if (ret>0) {
  430.         return 1;
  431.     }
  432.     printf("successfully LTR553_ALS Open!\r\n");
  433.     return 0;
  434. }

  436. uint8_t ltr553_ps_close()
  437. {
  438.         uint8_t ret = 0;

  440.         ret = ltr553_ps_set_power_mode(DEV_POWER_OFF);
  441.     if (ret>0) {
  442.         return 1;
  443.     }
  444.     printf("successfully LTR553_ALS Close!\r\n");
  445.     return 0;
  446. }

  448. void LTR_ALS_init()
  449. {
  450.         /*ID check*/
  451.         if(LTR553_id_check()>0){
  452.                 return;
  453.         }
  454.         if(ltr553_als_set_default_config()>0)
  455.                 return;
  456.         printf("successfully LTR553_ALS_init!\r\n");
  457. }

  459. void LTR_PS_init()
  460. {
  461.         /*ID check*/
  462.         if(LTR553_id_check()){
  463.                 return;
  464.         }
  465.         /*PS check*/
  466.         if(ltr553_ps_set_default_config()>0)
  467.                 return;
  468.         printf("successfully LTR553_PS_init!\r\n");
  469. }

  471. uint8_t read_als(uint32_t *als_data)
  472. {
  473.         HAL_StatusTypeDef hi2c2_status = 0x00;
  474.         /*
  475.          * LTR553_ALS_DATA1_L=0X88,LTR553_ALS_DATA1_H=0X89
  476.          * LTR553_ALS_DATA0_L=0X8A,LTR553_ALS_DATA0_H=0X8B
  477.          */
  478.         uint8_t ALS_addr[4] = {LTR553_ALS_DATA1_L,LTR553_ALS_DATA1_H
  479.                         ,LTR553_ALS_DATA0_L,LTR553_ALS_DATA0_H};
  480.         uint8_t ALS_data[4] = {0x00};
  481.         for(uint8_t i=0; i<4; i++){
  482.                 hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,ALS_addr[i],1,&ALS_data[i],1,1000);
  483.                 if(HAL_OK!=hi2c2_status){
  484.                                 return 1;
  485.                 }
  486.         }
  487.         uint32_t val01 = ALS_data[0]|(ALS_data[1]<<8);
  488.     uint32_t val02 = ALS_data[2]|(ALS_data[3]<<8);
  489.     printf("val01:%lu,val02:%lu\n",val01,val01);
  490.     *als_data =  (uint32_t)((val01 + val02) >> 1);
  491.     printf("als_data: %lu\r\n",*als_data);
  492.     return 0;
  493. }

  495. uint8_t read_ps(uint32_t *ps_data)
  496. {
  497.         HAL_StatusTypeDef hi2c2_status = 0x00;
  498.         /*
  499.          * LTR553_PS_DATA_L=0X8D,LTR553_PS_DATA_H=0X8E
  500.          */
  501.     uint8_t PS_addr[2] = {LTR553_PS_DATA_L,LTR553_PS_DATA_H};
  502.     uint8_t PS_data[2] = {0x00};
  503.     for(uint8_t i=0; i<2; i++){
  504.                 hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,LTR553_I2C_ADDR,PS_addr[i],1,&PS_data[i],1,1000);
  505.                 if(HAL_OK!=hi2c2_status){
  506.                                 return 1;
  507.                 }
  508.         }
  509.     uint32_t val03 = PS_data[0]|(PS_data[1]<<8);
  510.     printf("val03:%lu\n",val03);
  511.     *ps_data = val03;
  512.     printf("ps_data: %lu\r\n",*ps_data);
  513.     return 0;
  514. }
复制代码

七、BMP280传感器（气压传感器）
        在ICore源码目录下，创建bmp280文件夹，再在该目录下创建bmp280.h和bmp280.c源码文件，作为BMP280传感器驱动。
        同样在网上查找下载bmp280数据手册，逐步分析，bmp280的从设备地址(0XEE=0X77<<1),开发板同样做了微调，采用从机地址+寄存器地址+数据等方式通信，支持SPI或I2C通信，我们只研究I2C通信，如下：

 74f6fd3d0e7a4517a5bb79b509a6b2b1.png

        1）I2C读写通信设计如下

 ad1fca78c2194d52b84959127c53b741.png

3fbe006a91a24437b47869e5dcda1044.png

         2）设备ID寄存器地址0XD0，正确返回值应该是0X58，及软重置寄存器地址XE0，写入数据是0XB6重置生效，其他值无效。

 8de58caea465444688733403a358af08.png

         3）power模式设置地址0XF4，bit0~1设置0X03（0000 0011）开启正常模式，可以读取数据。bit5~7设置温度相关，bit2~4设置气压相关.

 f9111f328f404014a910ce94bc0e5cf8.png

66929cf672094ac5a0284cc48494a1ba.png

         4）设备参数配置地址0XF5，可设置设备作业的rate, filter and interface。I2C通信需要设置5~7bit。

 232f98f958884fc2a59c8f3989b31065.png

cfaae6539eff4b08ba3cda4367825a98.png


         5）数据读取时的微调参数配置，其中dig_T1、dig_T2、dig_T3是为温度数据调整使用，dig_P1~9是气压数据调整时使用。

 ca5a19d5ffb7425a8d6ba9bab17fc902.png

3d42145639cf48519c80f71cb2a96dd8.png

         6）读取数据，0XF7~F9读取气压相关数据，共3字节（24bit），0XFA~FC读取温度相关数据，共3字节（24bit）

 26bfbf7e4cb64ea0a8700df1ad3ef384.png

16737cecdc1742e8aa7fe1a60a34caba.png

         7）至此可设计出BMP280的伪代码
  1. bmp280从机地址0XEE
  2. init：
  3. read data1 from 从机地址0XEE 寄存器地址 0XD0
  4. 确保data1==0X58
  5. write 0XB6 to 从机地址0XEE 寄存器地址 0XE0 完成软重置
  6. write val1 to 从机地址0XEE 寄存器地址 0XF4 完成设备模式设置
  7. write val2 to 从机地址0XEE 寄存器地址 0XF5 完成设备参数设置
  8. read conf1~24 from 从机地址0XEE 寄存器地址 0X88~0XA1 获取数据换算微调参数

  10. 读取数据：
  11. 确保设备为正常模式，例如write 0X03 to 从机地址0XEE 寄存器地址 0XF4 完成设备模式设置
  12. read P1~3 from 从机地址0XEE 寄存器地址 0XF7~F9
  13. 将P1~3与conf4~24进行换算处理得到实际数据
  14. read t1~3 from 从机地址0XEE 寄存器地址 0XFA~FC
  15. 将t1~3与conf1~3进行换算处理得到实际数据
复制代码

         8)依据上面伪代码描述及数据手册分析，BMP280传感器驱动文件源码如下：

        bmp280.h
  1. #ifndef _BMP280_H_
  2. #define _BMP280_H_

  4. #include "main.h"

  6. void BMP280_init();
  7. uint8_t bmp280_open(void);
  8. uint8_t bmp280_close(void);
  9. uint8_t read_bmp280_temp(uint32_t *comp_temp);
  10. uint8_t read_bmp280_baro(uint32_t *comp_baro);
  11. #endif /* BMP280_BMP280_H_ */
复制代码

         bmp280.c
  1. #include <stdio.h>
  2. #include "bmp280.h"

  4. extern I2C_HandleTypeDef hi2c2;

  6. #define BMP280_TEMPERATURE_CALIB_DIG_T1_LSB_REG (0x88)
  7. #define BMP280_TEMPERATURE_CALIB_DIG_T1_MSB_REG (0x89)
  8. #define BMP280_TEMPERATURE_CALIB_DIG_T2_LSB_REG (0x8A)
  9. #define BMP280_TEMPERATURE_CALIB_DIG_T2_MSB_REG (0x8B)
  10. #define BMP280_TEMPERATURE_CALIB_DIG_T3_LSB_REG (0x8C)
  11. #define BMP280_TEMPERATURE_CALIB_DIG_T3_MSB_REG (0x8D)
  12. #define BMP280_PRESSURE_CALIB_DIG_P1_LSB_REG (0x8E)
  13. #define BMP280_PRESSURE_CALIB_DIG_P1_MSB_REG (0x8F)
  14. #define BMP280_PRESSURE_CALIB_DIG_P2_LSB_REG (0x90)
  15. #define BMP280_PRESSURE_CALIB_DIG_P2_MSB_REG (0x91)
  16. #define BMP280_PRESSURE_CALIB_DIG_P3_LSB_REG (0x92)
  17. #define BMP280_PRESSURE_CALIB_DIG_P3_MSB_REG (0x93)
  18. #define BMP280_PRESSURE_CALIB_DIG_P4_LSB_REG (0x94)
  19. #define BMP280_PRESSURE_CALIB_DIG_P4_MSB_REG (0x95)
  20. #define BMP280_PRESSURE_CALIB_DIG_P5_LSB_REG (0x96)
  21. #define BMP280_PRESSURE_CALIB_DIG_P5_MSB_REG (0x97)
  22. #define BMP280_PRESSURE_CALIB_DIG_P6_LSB_REG (0x98)
  23. #define BMP280_PRESSURE_CALIB_DIG_P6_MSB_REG (0x99)
  24. #define BMP280_PRESSURE_CALIB_DIG_P7_LSB_REG (0x9A)
  25. #define BMP280_PRESSURE_CALIB_DIG_P7_MSB_REG (0x9B)
  26. #define BMP280_PRESSURE_CALIB_DIG_P8_LSB_REG (0x9C)
  27. #define BMP280_PRESSURE_CALIB_DIG_P8_MSB_REG (0x9D)
  28. #define BMP280_PRESSURE_CALIB_DIG_P9_LSB_REG (0x9E)
  29. #define BMP280_PRESSURE_CALIB_DIG_P9_MSB_REG (0x9F)


  32. #define BMP280_CHIP_ID_REG (0xD0)
  33. #define BMP280_RST_REG (0xE0)
  34. #define BMP280_STAT_REG (0xF3)
  35. #define BMP280_CTRL_MEAS_REG (0xF4)
  36. #define BMP280_CONFIG_REG (0xF5)
  37. #define BMP280_PRESSURE_MSB_REG (0xF7)
  38. #define BMP280_PRESSURE_LSB_REG (0xF8)
  39. #define BMP280_PRESSURE_XLSB_REG (0xF9)
  40. #define BMP280_TEMPERATURE_MSB_REG (0xFA)
  41. #define BMP280_TEMPERATURE_LSB_REG (0xFB)
  42. #define BMP280_TEMPERATURE_XLSB_REG (0xFC)


  45. #define BMP280_SHIFT_BY_01_BIT (1)
  46. #define BMP280_SHIFT_BY_02_BITS (2)
  47. #define BMP280_SHIFT_BY_03_BITS (3)
  48. #define BMP280_SHIFT_BY_04_BITS (4)
  49. #define BMP280_SHIFT_BY_05_BITS (5)
  50. #define BMP280_SHIFT_BY_08_BITS (8)
  51. #define BMP280_SHIFT_BY_11_BITS (11)
  52. #define BMP280_SHIFT_BY_12_BITS (12)
  53. #define BMP280_SHIFT_BY_13_BITS (13)
  54. #define BMP280_SHIFT_BY_14_BITS (14)
  55. #define BMP280_SHIFT_BY_15_BITS (15)
  56. #define BMP280_SHIFT_BY_16_BITS (16)
  57. #define BMP280_SHIFT_BY_17_BITS (17)
  58. #define BMP280_SHIFT_BY_18_BITS (18)
  59. #define BMP280_SHIFT_BY_19_BITS (19)
  60. #define BMP280_SHIFT_BY_25_BITS (25)
  61. #define BMP280_SHIFT_BY_31_BITS (31)
  62. #define BMP280_SHIFT_BY_33_BITS (33)
  63. #define BMP280_SHIFT_BY_35_BITS (35)
  64. #define BMP280_SHIFT_BY_47_BITS (47)


  67. #define BMP280_PRESSURE_TEMPERATURE_CALIB_DATA_LENGTH (24)
  68. #define BMP280_GEN_READ_WRITE_DATA_LENGTH (1)
  69. #define BMP280_REGISTER_READ_DELAY (1)
  70. #define BMP280_TEMPERATURE_DATA_LENGTH (3)
  71. #define BMP280_PRESSURE_DATA_LENGTH (3)
  72. #define BMP280_ALL_DATA_FRAME_LENGTH (6)
  73. #define BMP280_INIT_VALUE (0)
  74. #define BMP280_CHIP_ID_READ_COUNT (5)
  75. #define BMP280_CHIP_ID_READ_SUCCESS (0)
  76. #define BMP280_CHIP_ID_READ_FAIL ((int8_t)-1)
  77. #define BMP280_INVALID_DATA (0)


  80. #define BMP280_TEMPERATURE_DATA_SIZE (3)
  81. #define BMP280_PRESSURE_DATA_SIZE (3)
  82. #define BMP280_DATA_FRAME_SIZE (6)
  83. #define BMP280_CALIB_DATA_SIZE (24)

  85. #define BMP280_TEMPERATURE_MSB_DATA (0)
  86. #define BMP280_TEMPERATURE_LSB_DATA (1)
  87. #define BMP280_TEMPERATURE_XLSB_DATA (2)


  90. #define BMP280_I2C_ADDRESS1 (0x76)
  91. #define BMP280_I2C_ADDRESS2 (0x77)


  94. #define BMP280_SLEEP_MODE (0x00)
  95. #define BMP280_FORCED_MODE (0x01)
  96. #define BMP280_NORMAL_MODE (0x03)
  97. #define BMP280_SOFT_RESET_CODE (0xB6)


  100. #define BMP280_STANDBY_TIME_1_MS (0x00)
  101. #define BMP280_STANDBY_TIME_63_MS (0x01)
  102. #define BMP280_STANDBY_TIME_125_MS (0x02)
  103. #define BMP280_STANDBY_TIME_250_MS (0x03)
  104. #define BMP280_STANDBY_TIME_500_MS (0x04)
  105. #define BMP280_STANDBY_TIME_1000_MS (0x05)
  106. #define BMP280_STANDBY_TIME_2000_MS (0x06)
  107. #define BMP280_STANDBY_TIME_4000_MS (0x07)


  110. #define BMP280_OVERSAMP_SKIPPED (0x00)
  111. #define BMP280_OVERSAMP_1X (0x01)
  112. #define BMP280_OVERSAMP_2X (0x02)
  113. #define BMP280_OVERSAMP_4X (0x03)
  114. #define BMP280_OVERSAMP_8X (0x04)
  115. #define BMP280_OVERSAMP_16X (0x05)

  117. #define BMP280_FILTER_COEFF_OFF (0x00)
  118. #define BMP280_FILTER_COEFF_2 (0x01)
  119. #define BMP280_FILTER_COEFF_4 (0x02)
  120. #define BMP280_FILTER_COEFF_8 (0x03)
  121. #define BMP280_FILTER_COEFF_16 (0x04)


  124. #define BMP280_ULTRA_LOW_POWER_MODE (0x00)
  125. #define BMP280_LOW_POWER_MODE (0x01)
  126. #define BMP280_STANDARD_RESOLUTION_MODE (0x02)
  127. #define BMP280_HIGH_RESOLUTION_MODE (0x03)
  128. #define BMP280_ULTRA_HIGH_RESOLUTION_MODE (0x04)

  130. #define BMP280_ULTRALOWPOWER_OVERSAMP_PRESSURE BMP280_OVERSAMP_1X
  131. #define BMP280_ULTRALOWPOWER_OVERSAMP_TEMPERATURE BMP280_OVERSAMP_1X

  133. #define BMP280_LOWPOWER_OVERSAMP_PRESSURE BMP280_OVERSAMP_2X
  134. #define BMP280_LOWPOWER_OVERSAMP_TEMPERATURE BMP280_OVERSAMP_1X

  136. #define BMP280_STANDARDRESOLUTION_OVERSAMP_PRESSURE BMP280_OVERSAMP_4X
  137. #define BMP280_STANDARDRESOLUTION_OVERSAMP_TEMPERATURE BMP280_OVERSAMP_1X

  139. #define BMP280_HIGHRESOLUTION_OVERSAMP_PRESSURE BMP280_OVERSAMP_8X
  140. #define BMP280_HIGHRESOLUTION_OVERSAMP_TEMPERATURE BMP280_OVERSAMP_1X

  142. #define BMP280_ULTRAHIGHRESOLUTION_OVERSAMP_PRESSURE BMP280_OVERSAMP_16X
  143. #define BMP280_ULTRAHIGHRESOLUTION_OVERSAMP_TEMPERATURE BMP280_OVERSAMP_2X


  146. #define BMP280_STATUS_REG_MEASURING__POS (3)
  147. #define BMP280_STATUS_REG_MEASURING__MSK (0x08)
  148. #define BMP280_STATUS_REG_MEASURING__LEN (1)
  149. #define BMP280_STATUS_REG_MEASURING__REG (BMP280_STAT_REG)

  151. #define BMP280_STATUS_REG_IM_UPDATE__POS (0)
  152. #define BMP280_STATUS_REG_IM_UPDATE__MSK (0x01)
  153. #define BMP280_STATUS_REG_IM_UPDATE__LEN (1)
  154. #define BMP280_STATUS_REG_IM_UPDATE__REG (BMP280_STAT_REG)


  157. #define BMP280_CTRL_MEAS_REG_OVERSAMP_TEMPERATURE__POS (5)
  158. #define BMP280_CTRL_MEAS_REG_OVERSAMP_TEMPERATURE__MSK (0xE0)
  159. #define BMP280_CTRL_MEAS_REG_OVERSAMP_TEMPERATURE__LEN (3)
  160. #define BMP280_CTRL_MEAS_REG_OVERSAMP_TEMPERATURE__REG (BMP280_CTRL_MEAS_REG)


  163. #define BMP280_CTRL_MEAS_REG_OVERSAMP_PRESSURE__POS (2)
  164. #define BMP280_CTRL_MEAS_REG_OVERSAMP_PRESSURE__MSK (0x1C)
  165. #define BMP280_CTRL_MEAS_REG_OVERSAMP_PRESSURE__LEN (3)
  166. #define BMP280_CTRL_MEAS_REG_OVERSAMP_PRESSURE__REG (BMP280_CTRL_MEAS_REG)

  168. #define BMP280_CTRL_MEAS_REG_POWER_MODE__POS (0)
  169. #define BMP280_CTRL_MEAS_REG_POWER_MODE__MSK (0x03)
  170. #define BMP280_CTRL_MEAS_REG_POWER_MODE__LEN (2)
  171. #define BMP280_CTRL_MEAS_REG_POWER_MODE__REG (BMP280_CTRL_MEAS_REG)


  174. #define BMP280_CONFIG_REG_STANDBY_DURN__POS (5)
  175. #define BMP280_CONFIG_REG_STANDBY_DURN__MSK (0xE0)
  176. #define BMP280_CONFIG_REG_STANDBY_DURN__LEN (3)
  177. #define BMP280_CONFIG_REG_STANDBY_DURN__REG (BMP280_CONFIG_REG)

  179. #define BMP280_CONFIG_REG_FILTER__POS (2)
  180. #define BMP280_CONFIG_REG_FILTER__MSK (0x1C)
  181. #define BMP280_CONFIG_REG_FILTER__LEN (3)
  182. #define BMP280_CONFIG_REG_FILTER__REG (BMP280_CONFIG_REG)


  185. #define BMP280_CONFIG_REG_SPI3_ENABLE__POS (0)
  186. #define BMP280_CONFIG_REG_SPI3_ENABLE__MSK (0x01)
  187. #define BMP280_CONFIG_REG_SPI3_ENABLE__LEN (1)
  188. #define BMP280_CONFIG_REG_SPI3_ENABLE__REG (BMP280_CONFIG_REG)


  191. #define BMP280_PRESSURE_XLSB_REG_DATA__POS (4)
  192. #define BMP280_PRESSURE_XLSB_REG_DATA__MSK (0xF0)
  193. #define BMP280_PRESSURE_XLSB_REG_DATA__LEN (4)
  194. #define BMP280_PRESSURE_XLSB_REG_DATA__REG (BMP280_PRESSURE_XLSB_REG)

  196. #define BMP280_TEMPERATURE_XLSB_REG_DATA__POS (4)
  197. #define BMP280_TEMPERATURE_XLSB_REG_DATA__MSK (0xF0)
  198. #define BMP280_TEMPERATURE_XLSB_REG_DATA__LEN (4)
  199. #define BMP280_TEMPERATURE_XLSB_REG_DATA__REG (BMP280_TEMPERATURE_XLSB_REG)

  201. #define BMP280_TEMPERATURE_MSB_DATA (0)
  202. #define BMP280_TEMPERATURE_LSB_DATA (1)
  203. #define BMP280_TEMPERATURE_XLSB_DATA (2)

  205. #define BMP280_PRESSURE_MSB_DATA (0)
  206. #define BMP280_PRESSURE_LSB_DATA (1)
  207. #define BMP280_PRESSURE_XLSB_DATA (2)

  209. #define BMP280_DATA_FRAME_PRESSURE_MSB_BYTE (0)
  210. #define BMP280_DATA_FRAME_PRESSURE_LSB_BYTE (1)
  211. #define BMP280_DATA_FRAME_PRESSURE_XLSB_BYTE (2)
  212. #define BMP280_DATA_FRAME_TEMPERATURE_MSB_BYTE (3)
  213. #define BMP280_DATA_FRAME_TEMPERATURE_LSB_BYTE (4)
  214. #define BMP280_DATA_FRAME_TEMPERATURE_XLSB_BYTE (5)

  216. #define BMP280_TEMPERATURE_CALIB_DIG_T1_LSB (0)
  217. #define BMP280_TEMPERATURE_CALIB_DIG_T1_MSB (1)
  218. #define BMP280_TEMPERATURE_CALIB_DIG_T2_LSB (2)
  219. #define BMP280_TEMPERATURE_CALIB_DIG_T2_MSB (3)
  220. #define BMP280_TEMPERATURE_CALIB_DIG_T3_LSB (4)
  221. #define BMP280_TEMPERATURE_CALIB_DIG_T3_MSB (5)
  222. #define BMP280_PRESSURE_CALIB_DIG_P1_LSB (6)
  223. #define BMP280_PRESSURE_CALIB_DIG_P1_MSB (7)
  224. #define BMP280_PRESSURE_CALIB_DIG_P2_LSB (8)
  225. #define BMP280_PRESSURE_CALIB_DIG_P2_MSB (9)
  226. #define BMP280_PRESSURE_CALIB_DIG_P3_LSB (10)
  227. #define BMP280_PRESSURE_CALIB_DIG_P3_MSB (11)
  228. #define BMP280_PRESSURE_CALIB_DIG_P4_LSB (12)
  229. #define BMP280_PRESSURE_CALIB_DIG_P4_MSB (13)
  230. #define BMP280_PRESSURE_CALIB_DIG_P5_LSB (14)
  231. #define BMP280_PRESSURE_CALIB_DIG_P5_MSB (15)
  232. #define BMP280_PRESSURE_CALIB_DIG_P6_LSB (16)
  233. #define BMP280_PRESSURE_CALIB_DIG_P6_MSB (17)
  234. #define BMP280_PRESSURE_CALIB_DIG_P7_LSB (18)
  235. #define BMP280_PRESSURE_CALIB_DIG_P7_MSB (19)
  236. #define BMP280_PRESSURE_CALIB_DIG_P8_LSB (20)
  237. #define BMP280_PRESSURE_CALIB_DIG_P8_MSB (21)
  238. #define BMP280_PRESSURE_CALIB_DIG_P9_LSB (22)
  239. #define BMP280_PRESSURE_CALIB_DIG_P9_MSB (23)

  241. #define BMP280_SOFT_RESRT_VALUE (0XB6)

  243. #define BMP280_I2C_SLAVE_ADDR_LOW (0X76)
  244. #define BMP280_I2C_SLAVE_ADDR_HIGH (0X77)

  246. #define BMP280_DEFAULT_ODR_1HZ (1)

  248. #define BMP280_BIT(x) ((uint8_t)(x))
  249. #define BMP280_CHIP_ID_VAL BMP280_BIT(0X58)
  250. #define BMP280_I2C_ADDR_TRANS(n) ((n) << 1)
  251. #define BMP280_I2C_ADDR BMP280_I2C_ADDR_TRANS(BMP280_I2C_SLAVE_ADDR_HIGH)


  254. #define BMP280_GET_BITSLICE(regvar, bitname) \
  255.     ((regvar & bitname##__MSK) >> bitname##__POS)
  256. #define BMP280_SET_BITSLICE(regvar, bitname, val) \
  257.     ((regvar & ~bitname##__MSK) | ((val << bitname##__POS) & bitname##__MSK))

  259. typedef struct bmp280_calib_param_t
  260. {
  261.     uint16_t dig_T1;
  262.     int16_t  dig_T2;
  263.     int16_t  dig_T3;
  264.     uint16_t dig_P1;
  265.     int16_t  dig_P2;
  266.     int16_t  dig_P3;
  267.     int16_t  dig_P4;
  268.     int16_t  dig_P5;
  269.     int16_t  dig_P6;
  270.     int16_t  dig_P7;
  271.     int16_t  dig_P8;
  272.     int16_t  dig_P9;
  273.     int      t_fine;
  274. } bmp280_calib_param_t;

  276. typedef struct bmp280_device_cfg_t
  277. {
  278.     uint8_t odr;
  279.     uint8_t mode_filter;
  280.     uint8_t mode_baro;
  281.     uint8_t mode_temp;
  282.     uint8_t mode_power;
  283.     uint8_t oversamp_temp;
  284.     uint8_t oversamp_baro;
  285. } bmp280_device_cfg_t;

  287. typedef enum {
  288.     DEV_POWER_OFF = 0,
  289.     DEV_POWER_ON,
  290.     DEV_SLEEP,
  291.     DEV_SUSPEND,
  292.     DEV_DEEP_SUSPEND,
  293. } bmp280_power_mode;

  295. typedef enum {
  296.     SENSOR_IOCTL_ODR_SET = 1,
  297.     SENSOR_IOCTL_RANGE_SET,
  298.     SENSOR_IOCTL_SET_POWER,
  299.     SENSOR_IOCTL_GET_INFO,
  300.     SENSOR_IOCTL_MAX
  301. } cmd_type;

  303. static bmp280_calib_param_t g_bmp280_calib_table;


  306. uint8_t bmp280_id_check()
  307. {
  308.         HAL_StatusTypeDef hi2c2_status = 0x00;
  309.         /*ID check*/
  310.         //BMP280_CHIP_ID_REG = 0XD0,BMP280_CHIP_ID_VAL = 0X58
  311.         uint8_t id_addr_val[3] = {0xD0,0x58,0x00};
  312.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,BMP280_I2C_ADDR,id_addr_val[0],1,&id_addr_val[2],1,1000);
  313.         if(HAL_OK!=hi2c2_status){
  314.                 printf("get part_id error\r\n");
  315.                 return 1;
  316.         }
  317.         if(id_addr_val[1]!=id_addr_val[2]){
  318.                 printf("bmp280_validate_id is error\r\n");
  319.                 return 1;
  320.         }
  321.         printf("bmp280_id:%02X\r\n",id_addr_val[2]);
  322.         return 0;
  323. }

  325. uint8_t bmp280_reset()
  326. {
  327.         HAL_StatusTypeDef hi2c2_status = 0x00;
  328.         /*reset*/
  329.         //BMP280_RST_REG = 0XE0,BMP280_SOFT_RESRT_VALUE=0XB6
  330.         uint8_t addr_val[2] = {BMP280_RST_REG,BMP280_SOFT_RESRT_VALUE};
  331.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,BMP280_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  332.         if(HAL_OK!=hi2c2_status){
  333.                 printf("bmp280_reset error\r\n");
  334.                 return 1;
  335.         }
  336.         return 0;
  337. }

  339. uint8_t bmp280_set_power_mode(bmp280_power_mode mode)
  340. {
  341.         uint8_t dev_mode = 0x00;
  342.     switch (mode) {
  343.         case DEV_POWER_OFF:
  344.         case DEV_SLEEP: {
  345.             dev_mode = (uint8_t)BMP280_SLEEP_MODE;
  346.             break;
  347.         }
  348.         case DEV_POWER_ON: {
  349.             dev_mode = (uint8_t)BMP280_NORMAL_MODE;
  350.             break;
  351.         }
  352.         default:
  353.             return 1;
  354.     }
  355.         HAL_StatusTypeDef hi2c2_status = 0x00;
  356.         //BMP280_CTRL_MEAS_REG=0XF4
  357.         uint8_t mode_addr_val[3] = {BMP280_CTRL_MEAS_REG,0x00,dev_mode};
  358.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,BMP280_I2C_ADDR,mode_addr_val[0],1,&mode_addr_val[1],1,1000);
  359.         if(HAL_OK!=hi2c2_status){
  360.                 printf("get bmp280_power_mode error\r\n");
  361.                 return 1;
  362.         }
  363.         printf("bmp280 mode_val[1]:%02X\r\n",mode_addr_val[1]);
  364.         mode_addr_val[1] = BMP280_SET_BITSLICE(mode_addr_val[1], BMP280_CTRL_MEAS_REG_POWER_MODE, mode_addr_val[2]);
  365.         printf("bmp280 mode_val[1]:%02X\r\n",mode_addr_val[1]);
  366.         /*reset*/
  367.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,BMP280_I2C_ADDR,mode_addr_val[0],1,&mode_addr_val[1],1,1000);
  368.         if(HAL_OK!=hi2c2_status){
  369.                 printf("bmp280_set_power_mode error\r\n");
  370.                 return 1;
  371.         }
  372.         return 0;
  373. }
  374. uint8_t bmp280_set_odr(uint8_t odr)
  375. {
  376.         HAL_StatusTypeDef hi2c2_status = 0x00;
  377.         //BMP280_CONFIG_REG_STANDBY_DURN__REG=0XF5
  378.         uint8_t odr_addr_val[2] = {BMP280_CONFIG_REG_STANDBY_DURN__REG,0x00};
  379.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,BMP280_I2C_ADDR,odr_addr_val[0],1,&odr_addr_val[1],1,1000);
  380.         if(HAL_OK!=hi2c2_status){
  381.                 printf("get bmp280_odr error\r\n");
  382.                 return 1;
  383.         }
  384.         printf("bmp280 odr_val[1]:%02X\r\n",odr_addr_val[1]);
  385.         //BMP280_DEFAULT_ODR_1HZ = 0X01
  386.         odr_addr_val[1] = BMP280_SET_BITSLICE(odr_addr_val[1], BMP280_CONFIG_REG_STANDBY_DURN, odr);
  387.         printf("bmp280 odr_val[1]:%02X\r\n",odr_addr_val[1]);
  388.         /*reset*/
  389.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,BMP280_I2C_ADDR,odr_addr_val[0],1,&odr_addr_val[1],1,1000);
  390.         if(HAL_OK!=hi2c2_status){
  391.                 printf("bmp280_set_odr error\r\n");
  392.                 return 1;
  393.         }
  394.         return 0;
  395. }

  397. static uint8_t bmp280_hz2odr(int hz)
  398. {
  399.     if (hz > 80) {
  400.         return BMP280_STANDBY_TIME_1_MS;
  401.     } else if (hz > 13) {
  402.         return BMP280_STANDBY_TIME_63_MS;
  403.     } else if (hz > 7) {
  404.         return BMP280_STANDBY_TIME_125_MS;
  405.     } else if (hz > 3) {
  406.         return BMP280_STANDBY_TIME_250_MS;
  407.     } else {
  408.         return BMP280_STANDBY_TIME_500_MS;
  409.     }
  410. }


  413. uint8_t bmp280_ioctl(cmd_type cmd,uint32_t arg)
  414. {
  415.         uint8_t ret = 0;
  416.     switch (cmd) {
  417.         case SENSOR_IOCTL_ODR_SET: {
  418.             uint8_t odr = bmp280_hz2odr(arg);
  419.             ret         = bmp280_set_odr( odr);
  420.             if (ret>0) {
  421.                 return 1;
  422.             }
  423.         } break;
  424.         case SENSOR_IOCTL_SET_POWER: {
  425.             ret = bmp280_set_power_mode(arg);
  426.             if (ret>0) {
  427.                 return 1;
  428.             }
  429.         } break;
  430.         case SENSOR_IOCTL_GET_INFO: {

  432.         } break;

  434.         default:
  435.             break;
  436.     }
  437.     return 0;
  438. }

  440. uint8_t bmp280_set_default_config()
  441. {
  442.         uint8_t ret = bmp280_set_power_mode(DEV_SLEEP);
  443.         if(ret>0)
  444.                 return 1;
  445.         ret = bmp280_set_odr(BMP280_DEFAULT_ODR_1HZ);
  446.         if(ret>0)
  447.                 return 1;
  448.         return 0;
  449. }

  451. uint8_t bmp280_get_calib_param()
  452. {
  453.         HAL_StatusTypeDef hi2c2_status = 0x00;
  454.         uint8_t data_u8[BMP280_CALIB_DATA_SIZE] = { 0x00 };
  455.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,BMP280_I2C_ADDR,BMP280_TEMPERATURE_CALIB_DIG_T1_LSB_REG
  456.                         ,1,data_u8,BMP280_PRESSURE_TEMPERATURE_CALIB_DATA_LENGTH,1000);
  457.         if(HAL_OK!=hi2c2_status){
  458.                 printf("get bmp280_calib_param error\r\n");
  459.                 return 1;
  460.         }
  461.         g_bmp280_calib_table.dig_T1 = (uint16_t)(
  462.                         (((uint16_t)((uint8_t)data_u8[BMP280_TEMPERATURE_CALIB_DIG_T1_MSB])) << BMP280_SHIFT_BY_08_BITS)
  463.                         | data_u8[BMP280_TEMPERATURE_CALIB_DIG_T1_LSB]);
  464.         g_bmp280_calib_table.dig_T2 = (int16_t)(
  465.               (((int16_t)((int8_t)data_u8[BMP280_TEMPERATURE_CALIB_DIG_T2_MSB])) << BMP280_SHIFT_BY_08_BITS)
  466.                    | data_u8[BMP280_TEMPERATURE_CALIB_DIG_T2_LSB]);
  467.         g_bmp280_calib_table.dig_T3 = (int16_t)(
  468.               (((int16_t)((int8_t)data_u8[BMP280_TEMPERATURE_CALIB_DIG_T3_MSB])) << BMP280_SHIFT_BY_08_BITS)
  469.                   | data_u8[BMP280_TEMPERATURE_CALIB_DIG_T3_LSB]);
  470.         g_bmp280_calib_table.dig_P1 = (uint16_t)(
  471.               (((uint16_t)((uint8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P1_MSB])) << BMP280_SHIFT_BY_08_BITS)
  472.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P1_LSB]);
  473.         g_bmp280_calib_table.dig_P2 = (int16_t)(
  474.               (((int16_t)((int8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P2_MSB])) << BMP280_SHIFT_BY_08_BITS)
  475.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P2_LSB]);
  476.         g_bmp280_calib_table.dig_P3 = (int16_t)(
  477.               (((int16_t)((int8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P3_MSB])) << BMP280_SHIFT_BY_08_BITS)
  478.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P3_LSB]);
  479.         g_bmp280_calib_table.dig_P4 = (int16_t)(
  480.               (((int16_t)((int8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P4_MSB])) << BMP280_SHIFT_BY_08_BITS)
  481.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P4_LSB]);
  482.         g_bmp280_calib_table.dig_P5 = (int16_t)(
  483.               (((int16_t)((int8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P5_MSB])) << BMP280_SHIFT_BY_08_BITS)
  484.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P5_LSB]);
  485.         g_bmp280_calib_table.dig_P6 = (int16_t)(
  486.               (((int16_t)((int8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P6_MSB])) << BMP280_SHIFT_BY_08_BITS)
  487.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P6_LSB]);
  488.         g_bmp280_calib_table.dig_P7 = (int16_t)(
  489.               (((int16_t)((int8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P7_MSB])) << BMP280_SHIFT_BY_08_BITS)
  490.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P7_LSB]);
  491.         g_bmp280_calib_table.dig_P8 = (int16_t)(
  492.               (((int16_t)((int8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P8_MSB])) << BMP280_SHIFT_BY_08_BITS)
  493.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P8_LSB]);
  494.         g_bmp280_calib_table.dig_P9 = (int16_t)(
  495.               (((int16_t)((int8_t)data_u8[BMP280_PRESSURE_CALIB_DIG_P9_MSB])) << BMP280_SHIFT_BY_08_BITS)
  496.                   | data_u8[BMP280_PRESSURE_CALIB_DIG_P9_LSB]);
  497.         return 0;
  498. }

  500. uint8_t bmp280_set_baro_work_mode(uint8_t mode)
  501. {
  502.     uint8_t value = 0;
  503.     uint8_t temp  = 0;
  504.     uint8_t baro  = 0;

  506.     switch (mode) {
  507.     case BMP280_ULTRA_LOW_POWER_MODE:
  508.         temp = BMP280_OVERSAMP_1X;
  509.         baro = BMP280_OVERSAMP_1X;
  510.         break;

  512.     case BMP280_LOW_POWER_MODE:
  513.         temp = BMP280_OVERSAMP_2X;
  514.         baro = BMP280_OVERSAMP_2X;
  515.         break;

  517.     case BMP280_STANDARD_RESOLUTION_MODE:
  518.         temp = BMP280_OVERSAMP_4X;
  519.         baro = BMP280_OVERSAMP_4X;
  520.         break;

  522.     case BMP280_HIGH_RESOLUTION_MODE:
  523.         temp = BMP280_OVERSAMP_8X;
  524.         baro = BMP280_OVERSAMP_8X;
  525.         break;

  527.     case BMP280_ULTRA_HIGH_RESOLUTION_MODE:
  528.         temp = BMP280_OVERSAMP_16X;
  529.         baro = BMP280_OVERSAMP_16X;
  530.         break;

  532.     default:
  533.         return 1;
  534.     }
  535.     HAL_StatusTypeDef hi2c2_status = 0x00;

  537.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,BMP280_I2C_ADDR,BMP280_CTRL_MEAS_REG
  538.                         ,1,&value,1,1000);
  539.         if(HAL_OK!=hi2c2_status){
  540.                 printf("get bmp280_calib_param error\r\n");
  541.                 return 1;
  542.         }
  543.         value =        BMP280_SET_BITSLICE(value, BMP280_CTRL_MEAS_REG_OVERSAMP_PRESSURE, baro);
  544.         value = BMP280_SET_BITSLICE(value, BMP280_CTRL_MEAS_REG_OVERSAMP_TEMPERATURE, temp);
  545.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c2,BMP280_I2C_ADDR,BMP280_CTRL_MEAS_REG,1,&value,1,1000);
  546.         if(HAL_OK!=hi2c2_status){
  547.                 printf("bmp280_set_power_mode error\r\n");
  548.                 return 1;
  549.         }
  550.         printf("successfully BMP280 set  baro_work_mode \r\n");
  551.         return 0;
  552. }

  554. uint8_t bmp280_open(void)
  555. {
  556.         uint8_t ret = bmp280_set_baro_work_mode(BMP280_ULTRA_LOW_POWER_MODE);
  557.         if(ret>0)
  558.                 return 1;
  559.         ret = bmp280_set_power_mode(DEV_POWER_ON);
  560.         if(ret>0)
  561.                 return 1;
  562.         return 0;
  563. }

  565. uint8_t bmp280_close(void)
  566. {
  567.         uint8_t ret = bmp280_set_power_mode(DEV_POWER_OFF);
  568.         if(ret>0)
  569.                 return 1;
  570.         return 0;
  571. }

  573. void BMP280_init()
  574. {
  575.         if(bmp280_id_check()>0)
  576.                 return;
  577.         if(bmp280_reset()>0)
  578.                 return;
  579.         if(bmp280_set_default_config()>0)
  580.                 return;
  581.         if(bmp280_get_calib_param()>0)
  582.                 return;
  583.         printf("successfully BMP280 init\r\n");
  584. }

  586. uint8_t read_bmp280_temp(uint32_t *comp_temp)
  587. {
  588.         *comp_temp = 0;
  589.         uint8_t data_u8[BMP280_TEMPERATURE_DATA_SIZE] = { 0 };
  590.         int32_t temp;
  591.         HAL_StatusTypeDef hi2c2_status = 0x00;

  593.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,BMP280_I2C_ADDR,BMP280_TEMPERATURE_MSB_REG
  594.                         ,1,data_u8,BMP280_TEMPERATURE_DATA_SIZE,1000);
  595.         if(HAL_OK!=hi2c2_status){
  596.                 printf("get bmp280_calib_param error\r\n");
  597.                 return 1;
  598.         }
  599.         temp = (int)((((uint32_t)(data_u8[BMP280_TEMPERATURE_MSB_DATA]))
  600.                         << BMP280_SHIFT_BY_12_BITS) | (((uint32_t)(data_u8[BMP280_TEMPERATURE_LSB_DATA]))
  601.                         << BMP280_SHIFT_BY_04_BITS) | ((uint32_t)data_u8[BMP280_TEMPERATURE_XLSB_DATA]
  602.                         >> BMP280_SHIFT_BY_04_BITS));
  603.         //
  604.     int v_x1_u32r = 0;
  605.     int v_x2_u32r = 0;
  606.     v_x1_u32r = ((((temp >> BMP280_SHIFT_BY_03_BITS) -
  607.                     ((int)g_bmp280_calib_table.dig_T1 << BMP280_SHIFT_BY_01_BIT))) *
  608.                     ((int)g_bmp280_calib_table.dig_T2)) >> BMP280_SHIFT_BY_11_BITS;

  610.     v_x2_u32r = (((((temp >> BMP280_SHIFT_BY_04_BITS) -
  611.                     ((int)g_bmp280_calib_table.dig_T1)) *
  612.                    ((temp >> BMP280_SHIFT_BY_04_BITS) -
  613.                     ((int)g_bmp280_calib_table.dig_T1))) >>
  614.                   BMP280_SHIFT_BY_12_BITS) *
  615.                  ((int)g_bmp280_calib_table.dig_T3)) >>
  616.                 BMP280_SHIFT_BY_14_BITS;

  618.     g_bmp280_calib_table.t_fine = v_x1_u32r + v_x2_u32r;

  620.     temp = (g_bmp280_calib_table.t_fine * 5 + 128) >> BMP280_SHIFT_BY_08_BITS;
  621.     printf("comp_temp: %d.%d\n", (int)temp/100, (int)(temp % 100));
  622.     *comp_temp = temp;
  623.     return 0;
  624. }

  626. uint8_t read_bmp280_baro(uint32_t *comp_baro)
  627. {
  628.         *comp_baro = 0;
  629.         uint8_t data_u8[BMP280_PRESSURE_DATA_SIZE] = { 0 };
  630.         int32_t temp;
  631.         HAL_StatusTypeDef hi2c2_status = 0x00;
  632.         //BMP280_PRESSURE_MSB_REG=0XF7,BMP280_PRESSURE_DATA_SIZE=0X03
  633.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c2,BMP280_I2C_ADDR,BMP280_PRESSURE_MSB_REG
  634.                                 ,1,data_u8,BMP280_PRESSURE_DATA_SIZE,1000);
  635.         if(HAL_OK!=hi2c2_status){
  636.                 printf("get bmp280_calib_param error\r\n");
  637.                 return 1;
  638.         }
  639.         temp = (int)(
  640.                         (((uint32_t)(data_u8[BMP280_PRESSURE_MSB_DATA])) << BMP280_SHIFT_BY_12_BITS)
  641.                         | (((uint32_t)(data_u8[BMP280_PRESSURE_LSB_DATA])) << BMP280_SHIFT_BY_04_BITS)
  642.                         | ((uint32_t)data_u8[BMP280_PRESSURE_XLSB_DATA]        >> BMP280_SHIFT_BY_04_BITS)
  643.                         );
  644.         //
  645.         int      v_x1_u32r = 0;
  646.         int      v_x2_u32r = 0;

  648.         v_x1_u32r = (((int)g_bmp280_calib_table.t_fine) >> BMP280_SHIFT_BY_01_BIT) - (int)64000;
  649.         v_x2_u32r = (((v_x1_u32r >> BMP280_SHIFT_BY_02_BITS) * (v_x1_u32r >> BMP280_SHIFT_BY_02_BITS)) >>
  650.                          BMP280_SHIFT_BY_11_BITS) * ((int)g_bmp280_calib_table.dig_P6);
  651.         v_x2_u32r = v_x2_u32r + ((v_x1_u32r * ((int)g_bmp280_calib_table.dig_P5)) << BMP280_SHIFT_BY_01_BIT);
  652.         v_x2_u32r = (v_x2_u32r >> BMP280_SHIFT_BY_02_BITS) + (((int)g_bmp280_calib_table.dig_P4) << BMP280_SHIFT_BY_16_BITS);
  653.         v_x1_u32r = (((g_bmp280_calib_table.dig_P3 *  (((v_x1_u32r >> BMP280_SHIFT_BY_02_BITS) *
  654.                         (v_x1_u32r >> BMP280_SHIFT_BY_02_BITS)) >> BMP280_SHIFT_BY_13_BITS)) >> BMP280_SHIFT_BY_03_BITS) +
  655.                 ((((int)g_bmp280_calib_table.dig_P2) * v_x1_u32r) >> BMP280_SHIFT_BY_01_BIT)) >> BMP280_SHIFT_BY_18_BITS;
  656.         v_x1_u32r = ((((32768 + v_x1_u32r)) * ((int)g_bmp280_calib_table.dig_P1)) >> BMP280_SHIFT_BY_15_BITS);
  657.         if (v_x1_u32r == 0)
  658.         {
  659.                 return 1; // avoid exception caused by division by zero
  660.         }
  661.         //
  662.         uint32_t val_baro = 0;
  663.         val_baro = (((uint32_t)(((int)1048576) - temp) - (v_x2_u32r >> BMP280_SHIFT_BY_12_BITS))) * 3125;

  665.         if (val_baro < 0x80000000) {
  666.                 if (v_x1_u32r != 0) {
  667.                         val_baro =        (val_baro << BMP280_SHIFT_BY_01_BIT) / ((uint32_t)v_x1_u32r);
  668.                 } else {
  669.                         return 1;
  670.                 }
  671.         } else if (v_x1_u32r != 0) {
  672.                 val_baro = (val_baro / (uint32_t)v_x1_u32r) * 2;
  673.         } else {
  674.                 return 1;
  675.         }
  676.         v_x1_u32r = (((int)g_bmp280_calib_table.dig_P9) * ((int)(((val_baro >> BMP280_SHIFT_BY_03_BITS) *
  677.                             (val_baro >> BMP280_SHIFT_BY_03_BITS)) >> BMP280_SHIFT_BY_13_BITS))) >> BMP280_SHIFT_BY_12_BITS;

  679.         v_x2_u32r = (((int)(val_baro >> BMP280_SHIFT_BY_02_BITS)) * ((int)g_bmp280_calib_table.dig_P8)) >>        BMP280_SHIFT_BY_13_BITS;

  681.         val_baro = (uint32_t)((int)val_baro +
  682.                             ((v_x1_u32r + v_x2_u32r + g_bmp280_calib_table.dig_P7) >> BMP280_SHIFT_BY_04_BITS));

  684.         printf("comp_baro:%d.%d\r\n",(int)val_baro/100, (int)(val_baro % 100));
  685.         *comp_baro = val_baro;
  686.         return 0;
  687. }
复制代码

八、LSM6DSL传感器（加速度及角速度）
在ICore源码目录下，创建LSM6DSL文件夹，再在该目录下创建LSM6DSL.h和LSM6DSL.c源文件。

        在网上查找下载LSM6DSL传感器数据手册，逐步分析，该传感器的I2C通信也是采用了从机地址+寄存器地址+数据的通信方式，传感器从设备地址0XD4(0X6A（01101010）<<1)如下：

 b79d278928b94a6fb6776e439825294f.png


        但中间这段文字描述翻译如下：LSM6DSL相关的从属AD地址（SAD）为110101xb。SDO/SA0引脚可用于修改设备地址的低位。如果SDO/SA0引脚连接到电源电压，LSb为“1”（地址1101011b）；否则，如果SDO/SA0引脚接地，则LSb值为“0”（地址1101010b）。该解决方案允许将两个不同的惯性模块连接并寻址到同一I2C总线，即有两个地址0X6A（1101010）、0X6B（1101011）。结合开发板的硬件原理图，在R500和R502接线下，取值不同，经测试0XD6、0XD7才能正确读取设备ID，开发板应该是R502接线，从设备地址是0XD6/0XD7。

 eaf902deb827438d8fc4ac3cbc41e7c0.png


        1）设备ID，地址是0X0F，正确返回值是0X6A

 9004193c9ad342b5a46ebb96a818e0ba.png


         2）软重置设置，寄存器地址是0X12，设置mydata|0x01可重置设备


f75814ebae5d49babb35f8d634ed803e.png

         3）acc加速度模式设置，涉及odr(rate、power)、 刻度(scale)、频宽、是否启动。

 d27f24f1f76d44388f88564c0185cf65.png

         4）Gyro角速度模式设置，涉及odr(rate)、刻度(scale)、是否启动。

 fcd753afc14b4bbbad014f47882a8d90.png

         5）读取数据 地址0X22~0X27为gyro数值，共6字节（16bit）.地址0X28~0X2D为acc数值，共6字节（16bit）

 590d66c447ff4f9f9754adcfdd85c1a0.png

        ACC和GYRO数值换算表如下，相关含义读者可以查找加速度及角速度相关知识了解：

 409cb62768154012b9ec5c47f9a002a4.png

         6）按以上分析，给出LSM6DSl传感器的伪代码
  1. LSM6DSL从机地址是0XD6
  2. init:
  3. read id from 从机地址是0XD6 寄存器地址0X0F
  4. 确定id==0X6A
  5. write myconf|0X01 to 从机地址是0XD6 寄存器地址0X12 软重置设备
  6. write mymode to 从机地址是0XD6 寄存器地址0X10 设置设备ACC模式
  7. write mymode to 从机地址是0XD6 寄存器地址0X11 设置设备GYRO模式

  9. 读取数据
  10. acc 读取数据前确保设置了相关参数，如power mode,range,频宽等，在寄存器地址0X10 设置
  11. read acc1~6 from 从机地址是0XD6 寄存器地址0X28,0X29,0X2A,0X2B,0X2C,0X2D
  12. acc1~6进行换算处理得到acc数值

  14. acc 读取数据前确保设置了相关参数，如power mode,range,频宽等，寄存器地址0X11设置
  15. read gyro1~6 from 从机地址是0XD6 寄存器地址0X22,0X23,0X24,0X25,0X26,0X27
  16. gyro1~6进行换算处理得到gyro数值
复制代码

         7)按以上分析及伪代码设计，LSM6DSL传感器的给出LSM6DSL.h和LSM6DSL.c源文件

        LSM6DSL.h
  1. #ifndef _LSM6DSL_H_
  2. #define _LSM6DSL_H_

  4. #include "main.h"

  6. void LSM6DSL_init();
  7. uint8_t LSM6DSL_acc_st_open(void);
  8. uint8_t LSM6DSL_acc_st_close(void);

  10. uint8_t LSM6DSL_gyro_st_open(void);
  11. uint8_t LSM6DSL_gyro_st_close(void);

  13. uint8_t LSM6DSL_acc_read(int32_t *x_data,int32_t *y_data,int32_t *z_data);
  14. uint8_t LSM6DSL_gyro_read(int32_t *x_data,int32_t *y_data,int32_t *z_data);

  16. #endif /* LSM6DSL_LSM6DSL_H_ */
复制代码

         LSM6DSL.c
  1. #include <stdio.h>
  2. #include "LSM6DSL.h"

  4. extern I2C_HandleTypeDef hi2c4;

  6. #define LSM6DSL_I2C_ADDR1 (0x6A)
  7. #define LSM6DSL_I2C_ADDR2 (0x6B)
  8. #define LSM6DSL_I2C_ADDR_TRANS(n) ((n) << 1)
  9. #define LSM6DSL_I2C_ADDR LSM6DSL_I2C_ADDR_TRANS(LSM6DSL_I2C_ADDR2)

  11. #define LSM6DSL_ACC_GYRO_FUNC_CFG_ACCESS 0x01
  12. #define LSM6DSL_ACC_GYRO_SENSOR_SYNC_TIME 0x04
  13. #define LSM6DSL_ACC_GYRO_SENSOR_RES_RATIO 0x05
  14. #define LSM6DSL_ACC_GYRO_FIFO_CTRL1 0x06
  15. #define LSM6DSL_ACC_GYRO_FIFO_CTRL2 0x07
  16. #define LSM6DSL_ACC_GYRO_FIFO_CTRL3 0x08
  17. #define LSM6DSL_ACC_GYRO_FIFO_CTRL4 0x09
  18. #define LSM6DSL_ACC_GYRO_FIFO_CTRL5 0x0A
  19. #define LSM6DSL_ACC_GYRO_DRDY_PULSE_CFG_G 0x0B
  20. #define LSM6DSL_ACC_GYRO_INT1_CTRL 0x0D
  21. #define LSM6DSL_ACC_GYRO_INT2_CTRL 0x0E
  22. #define LSM6DSL_ACC_GYRO_WHO_AM_I_REG 0x0F
  23. #define LSM6DSL_ACC_GYRO_CTRL1_XL 0x10
  24. #define LSM6DSL_ACC_GYRO_CTRL2_G 0x11
  25. #define LSM6DSL_ACC_GYRO_CTRL3_C 0x12
  26. #define LSM6DSL_ACC_GYRO_CTRL4_C 0x13
  27. #define LSM6DSL_ACC_GYRO_CTRL5_C 0x14
  28. #define LSM6DSL_ACC_GYRO_CTRL6_C 0x15
  29. #define LSM6DSL_ACC_GYRO_CTRL7_G 0x16
  30. #define LSM6DSL_ACC_GYRO_CTRL8_XL 0x17
  31. #define LSM6DSL_ACC_GYRO_CTRL9_XL 0x18
  32. #define LSM6DSL_ACC_GYRO_CTRL10_C 0x19


  35. #define LSM6DSL_ACC_GYRO_MASTER_CONFIG 0x1A
  36. #define LSM6DSL_ACC_GYRO_WAKE_UP_SRC 0x1B
  37. #define LSM6DSL_ACC_GYRO_TAP_SRC 0x1C
  38. #define LSM6DSL_ACC_GYRO_D6D_SRC 0x1D
  39. #define LSM6DSL_ACC_GYRO_STATUS_REG 0x1E

  41. #define LSM6DSL_ACC_GYRO_OUT_TEMP_L 0x20
  42. #define LSM6DSL_ACC_GYRO_OUT_TEMP_H 0x21
  43. #define LSM6DSL_ACC_GYRO_OUTX_L_G 0x22
  44. #define LSM6DSL_ACC_GYRO_OUTX_H_G 0x23
  45. #define LSM6DSL_ACC_GYRO_OUTY_L_G 0x24
  46. #define LSM6DSL_ACC_GYRO_OUTY_H_G 0x25
  47. #define LSM6DSL_ACC_GYRO_OUTZ_L_G 0x26
  48. #define LSM6DSL_ACC_GYRO_OUTZ_H_G 0x27
  49. #define LSM6DSL_ACC_GYRO_OUTX_L_XL 0x28
  50. #define LSM6DSL_ACC_GYRO_OUTX_H_XL 0x29
  51. #define LSM6DSL_ACC_GYRO_OUTY_L_XL 0x2A
  52. #define LSM6DSL_ACC_GYRO_OUTY_H_XL 0x2B
  53. #define LSM6DSL_ACC_GYRO_OUTZ_L_XL 0x2C
  54. #define LSM6DSL_ACC_GYRO_OUTZ_H_XL 0x2D
  55. #define LSM6DSL_ACC_GYRO_SENSORHUB1_REG 0x2E
  56. #define LSM6DSL_ACC_GYRO_SENSORHUB2_REG 0x2F
  57. #define LSM6DSL_ACC_GYRO_SENSORHUB3_REG 0x30
  58. #define LSM6DSL_ACC_GYRO_SENSORHUB4_REG 0x31
  59. #define LSM6DSL_ACC_GYRO_SENSORHUB5_REG 0x32
  60. #define LSM6DSL_ACC_GYRO_SENSORHUB6_REG 0x33
  61. #define LSM6DSL_ACC_GYRO_SENSORHUB7_REG 0x34
  62. #define LSM6DSL_ACC_GYRO_SENSORHUB8_REG 0x35
  63. #define LSM6DSL_ACC_GYRO_SENSORHUB9_REG 0x36
  64. #define LSM6DSL_ACC_GYRO_SENSORHUB10_REG 0x37
  65. #define LSM6DSL_ACC_GYRO_SENSORHUB11_REG 0x38
  66. #define LSM6DSL_ACC_GYRO_SENSORHUB12_REG 0x39
  67. #define LSM6DSL_ACC_GYRO_FIFO_STATUS1 0x3A
  68. #define LSM6DSL_ACC_GYRO_FIFO_STATUS2 0x3B
  69. #define LSM6DSL_ACC_GYRO_FIFO_STATUS3 0x3C
  70. #define LSM6DSL_ACC_GYRO_FIFO_STATUS4 0x3D
  71. #define LSM6DSL_ACC_GYRO_FIFO_DATA_OUT_L 0x3E
  72. #define LSM6DSL_ACC_GYRO_FIFO_DATA_OUT_H 0x3F
  73. #define LSM6DSL_ACC_GYRO_TIMESTAMP0_REG 0x40
  74. #define LSM6DSL_ACC_GYRO_TIMESTAMP1_REG 0x41
  75. #define LSM6DSL_ACC_GYRO_TIMESTAMP2_REG 0x42

  77. #define LSM6DSL_ACC_GYRO_TIMESTAMP_L 0x49
  78. #define LSM6DSL_ACC_GYRO_TIMESTAMP_H 0x4A

  80. #define LSM6DSL_ACC_GYRO_STEP_COUNTER_L 0x4B
  81. #define LSM6DSL_ACC_GYRO_STEP_COUNTER_H 0x4C

  83. #define LSM6DSL_ACC_GYRO_SENSORHUB13_REG 0x4D
  84. #define LSM6DSL_ACC_GYRO_SENSORHUB14_REG 0x4E
  85. #define LSM6DSL_ACC_GYRO_SENSORHUB15_REG 0x4F
  86. #define LSM6DSL_ACC_GYRO_SENSORHUB16_REG 0x50
  87. #define LSM6DSL_ACC_GYRO_SENSORHUB17_REG 0x51
  88. #define LSM6DSL_ACC_GYRO_SENSORHUB18_REG 0x52

  90. #define LSM6DSL_ACC_GYRO_FUNC_SRC 0x53
  91. #define LSM6DSL_ACC_GYRO_TAP_CFG1 0x58
  92. #define LSM6DSL_ACC_GYRO_TAP_THS_6D 0x59
  93. #define LSM6DSL_ACC_GYRO_INT_DUR2 0x5A
  94. #define LSM6DSL_ACC_GYRO_WAKE_UP_THS 0x5B
  95. #define LSM6DSL_ACC_GYRO_WAKE_UP_DUR 0x5C
  96. #define LSM6DSL_ACC_GYRO_FREE_FALL 0x5D
  97. #define LSM6DSL_ACC_GYRO_MD1_CFG 0x5E
  98. #define LSM6DSL_ACC_GYRO_MD2_CFG 0x5F

  100. #define LSM6DSL_ACC_GYRO_OUT_MAG_RAW_X_L 0x66
  101. #define LSM6DSL_ACC_GYRO_OUT_MAG_RAW_X_H 0x67
  102. #define LSM6DSL_ACC_GYRO_OUT_MAG_RAW_Y_L 0x68
  103. #define LSM6DSL_ACC_GYRO_OUT_MAG_RAW_Y_H 0x69
  104. #define LSM6DSL_ACC_GYRO_OUT_MAG_RAW_Z_L 0x6A
  105. #define LSM6DSL_ACC_GYRO_OUT_MAG_RAW_Z_H 0x6B

  107. #define LSM6DSL_ACC_GYRO_X_OFS_USR 0x73
  108. #define LSM6DSL_ACC_GYRO_Y_OFS_USR 0x74
  109. #define LSM6DSL_ACC_GYRO_Z_OFS_USR 0x75

  111. #define LSM6DSL_CHIP_ID_VALUE (0x6A)

  113. #define LSM6DSL_RESET_VALUE (0x1)
  114. #define LSM6DSL_RESET_MSK (0X1)
  115. #define LSM6DSL_RESET_POS (0)

  117. #define LSM6DSL_ACC_ODR_POWER_DOWN (0X00)
  118. #define LSM6DSL_ACC_ODR_1_6_HZ (0X0B)
  119. #define LSM6DSL_ACC_ODR_12_5_HZ (0x01)
  120. #define LSM6DSL_ACC_ODR_26_HZ (0x02)
  121. #define LSM6DSL_ACC_ODR_52_HZ (0x03)
  122. #define LSM6DSL_ACC_ODR_104_HZ (0x04)
  123. #define LSM6DSL_ACC_ODR_208_HZ (0x05)
  124. #define LSM6DSL_ACC_ODR_416_HZ (0x06)
  125. #define LSM6DSL_ACC_ODR_833_HZ (0x07)
  126. #define LSM6DSL_ACC_ODR_1_66_KHZ (0x08)
  127. #define LSM6DSL_ACC_ODR_3_33_KHZ (0x09)
  128. #define LSM6DSL_ACC_ODR_6_66_KHZ (0x0A)
  129. #define LSM6DSL_ACC_ODR_MSK (0XF0)
  130. #define LSM6DSL_ACC_ODR_POS (4)

  132. #define LSM6DSL_GYRO_ODR_POWER_DOWN (0X00)
  133. #define LSM6DSL_GYRO_ODR_12_5_HZ (0x01)
  134. #define LSM6DSL_GYRO_ODR_26_HZ (0x02)
  135. #define LSM6DSL_GYRO_ODR_52_HZ (0x03)
  136. #define LSM6DSL_GYRO_ODR_104_HZ (0x04)
  137. #define LSM6DSL_GYRO_ODR_208_HZ (0x05)
  138. #define LSM6DSL_GYRO_ODR_416_HZ (0x06)
  139. #define LSM6DSL_GYRO_ODR_833_HZ (0x07)
  140. #define LSM6DSL_GYRO_ODR_1_66_KHZ (0x08)
  141. #define LSM6DSL_GYRO_ODR_3_33_KHZ (0x09)
  142. #define LSM6DSL_GYRO_ODR_6_66_KHZ (0x0A)
  143. #define LSM6DSL_GYRO_ODR_MSK (0XF0)
  144. #define LSM6DSL_GYRO_ODR_POS (4)

  146. #define LSM6DSL_ACC_RANGE_2G (0x0)
  147. #define LSM6DSL_ACC_RANGE_4G (0x2)
  148. #define LSM6DSL_ACC_RANGE_8G (0x3)
  149. #define LSM6DSL_ACC_RANGE_16G (0x1)
  150. #define LSM6DSL_ACC_RANGE_MSK (0X0C)
  151. #define LSM6DSL_ACC_RANGE_POS (2)

  153. #define LSM6DSL_ACC_SENSITIVITY_2G (61)
  154. #define LSM6DSL_ACC_SENSITIVITY_4G (122)
  155. #define LSM6DSL_ACC_SENSITIVITY_8G (244)
  156. #define LSM6DSL_ACC_SENSITIVITY_16G (488)

  158. #define LSM6DSL_GYRO_RANGE_245 (0x0)
  159. #define LSM6DSL_GYRO_RANGE_500 (0x1)
  160. #define LSM6DSL_GYRO_RANGE_1000 (0x2)
  161. #define LSM6DSL_GYRO_RANGE_2000 (0x3)
  162. #define LSM6DSL_GYRO_RANGE_MSK (0X0C)
  163. #define LSM6DSL_GYRO_RANGE_POS (2)

  165. #define LSM6DSL_GYRO_SENSITIVITY_245DPS (8750)
  166. #define LSM6DSL_GYRO_SENSITIVITY_500DPS (17500)
  167. #define LSM6DSL_GYRO_SENSITIVITY_1000DPS (35000)
  168. #define LSM6DSL_GYRO_SENSITIVITY_2000DPS (70000)

  170. #define LSM6DSL_SHIFT_EIGHT_BITS (8)
  171. #define LSM6DSL_16_BIT_SHIFT (0xFF)
  172. #define LSM6DSL_ACC_MUL (1000)
  173. #define LSM6DSL_GYRO_MUL (1)

  175. #define LSM6DSL_ACC_DEFAULT_ODR_100HZ (100)
  176. #define LSM6DSL_GYRO_DEFAULT_ODR_100HZ (100)

  178. #define LSM6DSL_GET_BITSLICE(regvar, bitname) \
  179.     ((regvar & bitname##_MSK) >> bitname##_POS)

  181. #define LSM6DSL_SET_BITSLICE(regvar, bitname, val) \
  182.     ((regvar & ~bitname##_MSK) | ((val << bitname##_POS) & bitname##_MSK))

  184. typedef enum {
  185.     ACC_RANGE_2G,
  186.     ACC_RANGE_4G,
  187.     ACC_RANGE_8G,
  188.     ACC_RANGE_16G,
  189.     ACC_RANGE_6G,
  190.     ACC_RANGE_12G,
  191.     ACC_RANGE_24G,
  192.     ACC_RANGE_100G,
  193.     ACC_RANGE_200G,
  194.     ACC_RANGE_400G,
  195.     ACC_RANGE_MAX
  196. } acc_range_e;

  198. typedef enum {
  199.     GYRO_RANGE_125DPS,
  200.     GYRO_RANGE_250DPS,
  201.     GYRO_RANGE_500DPS,
  202.     GYRO_RANGE_1000DPS,
  203.     GYRO_RANGE_2000DPS,
  204.     GYRO_RANGE_MAX
  205. } gyro_range_e;

  207. static int32_t lsm6dsl_acc_factor[ACC_RANGE_MAX] = {
  208.     LSM6DSL_ACC_SENSITIVITY_2G, LSM6DSL_ACC_SENSITIVITY_4G,
  209.     LSM6DSL_ACC_SENSITIVITY_8G, LSM6DSL_ACC_SENSITIVITY_16G
  210. };
  211. static int32_t lsm6dsl_gyro_factor[GYRO_RANGE_MAX] = {
  212.     0, LSM6DSL_GYRO_SENSITIVITY_245DPS, LSM6DSL_GYRO_SENSITIVITY_500DPS,
  213.     LSM6DSL_GYRO_SENSITIVITY_1000DPS, LSM6DSL_GYRO_SENSITIVITY_2000DPS
  214. };

  216. typedef enum {
  217.     DEV_POWER_OFF = 0,
  218.     DEV_POWER_ON,
  219.     DEV_SLEEP,
  220.     DEV_SUSPEND,
  221.     DEV_DEEP_SUSPEND,
  222. } LSM6DSL_power_mode;

  224. static int32_t cur_acc_factor  = 0;
  225. static int32_t cur_gyro_factor = 0;

  227. uint8_t LSM6DSL_ID_check()
  228. {
  229.         HAL_StatusTypeDef hi2c2_status = 0x00;
  230.         uint8_t addr_val[3] = {LSM6DSL_ACC_GYRO_WHO_AM_I_REG,0x00,LSM6DSL_CHIP_ID_VALUE};
  231.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  232.         if(HAL_OK!=hi2c2_status){
  233.                 printf("get LSM6DSL ID error\r\n");
  234.                 return 1;
  235.         }
  236.         if(addr_val[1]!=addr_val[2]){
  237.                 printf("LSM6DSL validate_id is error\r\n");
  238.                 return 1;
  239.         }
  240.         printf("LSM6DSL_id:%02X\r\n",addr_val[1]);
  241.         return 0;
  242. }

  244. uint8_t LSM6DSL_soft_reset()
  245. {
  246.         HAL_StatusTypeDef hi2c2_status = 0x00;
  247.         /*first read*/
  248.         uint8_t addr_val[2] = {LSM6DSL_ACC_GYRO_CTRL3_C,0x00};
  249.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  250.         if(HAL_OK!=hi2c2_status){
  251.                 printf("get LSM6DSL ACC_GYRO_CTRL3_C error\r\n");
  252.                 return 1;
  253.         }
  254.         printf("LSM6DSL ACC_GYRO_CTRL3_C old:%02X\r\n",addr_val[1]);
  255.         addr_val[1] |= LSM6DSL_RESET_VALUE;
  256.         printf("LSM6DSL ACC_GYRO_CTRL3_C new:%02X\r\n",addr_val[1]);
  257.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  258.         if(HAL_OK!=hi2c2_status){
  259.                 printf("set LSM6DSL ACC_GYRO_CTRL3_C error\r\n");
  260.                 return 1;
  261.         }
  262.         printf("successfully LSM6DSL soft reset\r\n");
  263.         return 0;
  264. }
  265. /*
  266. * 以正数为例，最大可到32767，如果是Accelerometer数据，量程为2g的情况下，
  267. * 32768个刻度，一个刻度代表：2g/32768 = 2000mg/32767 = 0.061035mg
  268. * 例如：如果读出数据为16384，则加速度：16384x0.061035mg = 1000mg = 1g
  269. */
  270. uint8_t LSM6DSL_acc_set_range(uint32_t range)
  271. {
  272.         HAL_StatusTypeDef hi2c2_status = 0x00;
  273.         /*first read*/
  274.         uint8_t addr_val[2] = {LSM6DSL_ACC_GYRO_CTRL1_XL,0x00};
  275.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  276.         if(HAL_OK!=hi2c2_status){
  277.                 printf("get LSM6DSL acc range error\r\n");
  278.                 return 1;
  279.         }
  280.         uint8_t tmp   = 0;
  281.     switch (range) {
  282.             case ACC_RANGE_2G: {
  283.             tmp = LSM6DSL_ACC_RANGE_2G;
  284.         } break;

  286.         case ACC_RANGE_4G: {
  287.             tmp = LSM6DSL_ACC_RANGE_4G;
  288.         } break;

  290.         case ACC_RANGE_8G: {
  291.             tmp = LSM6DSL_ACC_RANGE_8G;
  292.         } break;

  294.         case ACC_RANGE_16G: {
  295.             tmp = LSM6DSL_ACC_RANGE_16G;
  296.         } break;

  298.         default:
  299.             break;
  300.     }
  301.     addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_ACC_RANGE, tmp);
  302.     hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  303.         if(HAL_OK!=hi2c2_status){
  304.                 printf("set LSM6DSL acc range error\r\n");
  305.                 return 1;
  306.         }
  307.         if (range <= ACC_RANGE_16G) {
  308.         cur_acc_factor = lsm6dsl_acc_factor[range];
  309.     }
  310.         printf("successfully LSM6DSL set acc range\r\n");
  311.         return 0;
  312. }

  314. static uint8_t acc_st_lsm6dsl_hz2odr(uint32_t hz)
  315. {
  316.     if (hz > 3330)
  317.         return LSM6DSL_ACC_ODR_6_66_KHZ;
  318.     else if (hz > 1660)
  319.         return LSM6DSL_ACC_ODR_3_33_KHZ;
  320.     else if (hz > 833)
  321.         return LSM6DSL_ACC_ODR_1_66_KHZ;
  322.     else if (hz > 416)
  323.         return LSM6DSL_ACC_ODR_833_HZ;
  324.     else if (hz > 208)
  325.         return LSM6DSL_ACC_ODR_416_HZ;
  326.     else if (hz > 104)
  327.         return LSM6DSL_ACC_ODR_208_HZ;
  328.     else if (hz > 52)
  329.         return LSM6DSL_ACC_ODR_104_HZ;
  330.     else if (hz > 26)
  331.         return LSM6DSL_ACC_ODR_52_HZ;
  332.     else if (hz > 13)
  333.         return LSM6DSL_ACC_ODR_26_HZ;
  334.     else if (hz >= 2)
  335.         return LSM6DSL_ACC_ODR_12_5_HZ;
  336.     else
  337.         return LSM6DSL_ACC_ODR_1_6_HZ;
  338. }

  340. uint8_t LSM6DSL_acc_set_odr(uint32_t hz)
  341. {
  342.         HAL_StatusTypeDef hi2c2_status = 0x00;
  343.         /*first read*/
  344.         uint8_t addr_val[2] = {LSM6DSL_ACC_GYRO_CTRL1_XL,0x00};
  345.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  346.         if(HAL_OK!=hi2c2_status){
  347.                 printf("get LSM6DSL acc odr error\r\n");
  348.                 return 1;
  349.         }
  350.         uint8_t odr   = acc_st_lsm6dsl_hz2odr(hz);
  351.         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_ACC_ODR, odr);
  352.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  353.         if(HAL_OK!=hi2c2_status){
  354.                 printf("set LSM6DSL acc odr error\r\n");
  355.                 return 1;
  356.         }
  357.         printf("successfully LSM6DSL set acc odr\r\n");
  358.         return 0;
  359. }

  361. uint8_t LSM6DSL_acc_power_mode(LSM6DSL_power_mode mode)
  362. {
  363.         HAL_StatusTypeDef hi2c2_status = 0x00;
  364.         /*first read*/
  365.         uint8_t addr_val[2] = {LSM6DSL_ACC_GYRO_CTRL1_XL,0x00};
  366.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  367.         if(HAL_OK!=hi2c2_status){
  368.                 printf("get LSM6DSL acc power_mode error\r\n");
  369.                 return 1;
  370.         }
  371.         switch (mode) {
  372.                 case DEV_POWER_ON: {
  373.                         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_ACC_ODR,LSM6DSL_ACC_ODR_12_5_HZ);
  374.                 }
  375.                 break;
  376.                 case DEV_POWER_OFF: {
  377.                         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_ACC_ODR,LSM6DSL_ACC_ODR_POWER_DOWN);
  378.                 }
  379.                 break;
  380.                 case DEV_SLEEP: {
  381.                         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_ACC_ODR,LSM6DSL_ACC_ODR_12_5_HZ);
  382.                 }
  383.                 break;
  384.                 default:
  385.                         break;
  386.         }
  387.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  388.         if(HAL_OK!=hi2c2_status){
  389.                 printf("set LSM6DSL acc power_mode error\r\n");
  390.                 return 1;
  391.         }
  392.         printf("successfully LSM6DSL acc power_mode\r\n");
  393.         return 0;
  394. }

  396. uint8_t LSM6DSL_acc_st_open(void)
  397. {
  398.         uint8_t ret = 0;

  400.     ret = LSM6DSL_acc_power_mode( DEV_POWER_ON);
  401.     if (ret>0) {
  402.         return ret;
  403.     }

  405.     ret = LSM6DSL_acc_set_range(ACC_RANGE_8G);
  406.     if (ret>0) {
  407.         return ret;
  408.     }

  410.     ret = LSM6DSL_acc_set_odr(LSM6DSL_ACC_DEFAULT_ODR_100HZ);
  411.     if (ret>0) {
  412.         return ret;
  413.     }
  414.     printf("successfully LSM6DSL acc open\r\n");
  415.     return 0;
  416. }

  418. uint8_t LSM6DSL_acc_st_close(void)
  419. {
  420.         uint8_t ret = 0;
  421.     ret = LSM6DSL_acc_power_mode(DEV_POWER_OFF);
  422.     if (ret>0) {
  423.         return ret;
  424.     }
  425.     printf("successfully LSM6DSL acc close\r\n");
  426.     return 0;
  427. }

  429. uint8_t LSM6DSL_gyro_set_range(uint32_t range)
  430. {
  431.         HAL_StatusTypeDef hi2c2_status = 0x00;
  432.         /*first read*/
  433.         uint8_t addr_val[2] = {LSM6DSL_ACC_GYRO_CTRL2_G,0x00};
  434.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  435.         if(HAL_OK!=hi2c2_status){
  436.                 printf("get LSM6DSL gyro range error\r\n");
  437.                 return 1;
  438.         }
  439.         uint8_t tmp   = 0;
  440.         switch (range) {
  441.             case GYRO_RANGE_250DPS: {
  442.             tmp = LSM6DSL_GYRO_RANGE_245;
  443.         } break;

  445.         case GYRO_RANGE_500DPS: {
  446.             tmp = LSM6DSL_GYRO_RANGE_500;
  447.         } break;

  449.         case GYRO_RANGE_1000DPS: {
  450.             tmp = LSM6DSL_GYRO_RANGE_1000;
  451.         } break;

  453.         case GYRO_RANGE_2000DPS: {
  454.             tmp = LSM6DSL_GYRO_RANGE_2000;
  455.         } break;

  457.         default:
  458.             break;
  459.         }
  460.         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_GYRO_RANGE, tmp);
  461.     hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  462.         if(HAL_OK!=hi2c2_status){
  463.                 printf("set LSM6DSL gyro range error\r\n");
  464.                 return 1;
  465.         }
  466.         if ((range >= GYRO_RANGE_250DPS) && (range <= GYRO_RANGE_2000DPS)) {
  467.         cur_gyro_factor = lsm6dsl_gyro_factor[range];
  468.     }
  469.         printf("successfully LSM6DSL set gyro range\r\n");
  470.         return 0;
  471. }

  473. static uint8_t gyro_st_lsm6dsl_hz2odr(uint32_t hz)
  474. {
  475.     if (hz > 3330)
  476.         return LSM6DSL_GYRO_ODR_6_66_KHZ;
  477.     else if (hz > 1660)
  478.         return LSM6DSL_GYRO_ODR_3_33_KHZ;
  479.     else if (hz > 833)
  480.         return LSM6DSL_GYRO_ODR_1_66_KHZ;
  481.     else if (hz > 416)
  482.         return LSM6DSL_GYRO_ODR_833_HZ;
  483.     else if (hz > 208)
  484.         return LSM6DSL_GYRO_ODR_416_HZ;
  485.     else if (hz > 104)
  486.         return LSM6DSL_GYRO_ODR_208_HZ;
  487.     else if (hz > 52)
  488.         return LSM6DSL_GYRO_ODR_104_HZ;
  489.     else if (hz > 26)
  490.         return LSM6DSL_GYRO_ODR_52_HZ;
  491.     else if (hz > 13)
  492.         return LSM6DSL_GYRO_ODR_26_HZ;
  493.     else
  494.         return LSM6DSL_GYRO_ODR_12_5_HZ;
  495. }

  497. uint8_t LSM6DSL_gyro_set_odr(uint32_t hz)
  498. {
  499.         HAL_StatusTypeDef hi2c2_status = 0x00;
  500.         /*first read*/
  501.         uint8_t addr_val[2] = {LSM6DSL_ACC_GYRO_CTRL2_G,0x00};
  502.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  503.         if(HAL_OK!=hi2c2_status){
  504.                 printf("get LSM6DSL gyro odr error\r\n");
  505.                 return 1;
  506.         }
  507.         uint8_t odr = gyro_st_lsm6dsl_hz2odr(hz);
  508.         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_GYRO_ODR, odr);
  509.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  510.         if(HAL_OK!=hi2c2_status){
  511.                 printf("set LSM6DSL gyro odr error\r\n");
  512.                 return 1;
  513.         }
  514.         printf("successfully LSM6DSL set gyro odr\r\n");
  515.         return 0;
  516. }

  518. uint8_t LSM6DSL_gyro_power_mode(LSM6DSL_power_mode mode)
  519. {
  520.         HAL_StatusTypeDef hi2c2_status = 0x00;
  521.         /*first read*/
  522.         uint8_t addr_val[2] = {LSM6DSL_ACC_GYRO_CTRL2_G,0x00};
  523.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  524.         if(HAL_OK!=hi2c2_status){
  525.                 printf("get LSM6DSL gyro power_mode error\r\n");
  526.                 return 1;
  527.         }
  528.         switch (mode) {
  529.                 case DEV_POWER_ON: {
  530.                         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_GYRO_ODR,LSM6DSL_GYRO_ODR_12_5_HZ);
  531.                         break;
  532.                 }
  533.                 case DEV_POWER_OFF: {
  534.                         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_GYRO_ODR,LSM6DSL_GYRO_ODR_POWER_DOWN);
  535.                         break;
  536.                 }
  537.                 case DEV_SLEEP: {
  538.                         addr_val[1] = LSM6DSL_SET_BITSLICE(addr_val[1], LSM6DSL_GYRO_ODR,LSM6DSL_GYRO_ODR_12_5_HZ);
  539.                         break;
  540.                 }
  541.                 default:
  542.                         break;
  543.         }
  544.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,LSM6DSL_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  545.         if(HAL_OK!=hi2c2_status){
  546.                 printf("set LSM6DSL gyro power_mode error\r\n");
  547.                 return 1;
  548.         }
  549.         printf("successfully LSM6DSL gyro power_mode\r\n");
  550.         return 0;
  551. }

  553. uint8_t LSM6DSL_gyro_st_open(void)
  554. {
  555.         uint8_t ret = 0;
  556.     ret        = LSM6DSL_gyro_power_mode(DEV_POWER_ON);
  557.     if (ret>0) {
  558.         return 1;
  559.     }

  561.     ret = LSM6DSL_gyro_set_range(GYRO_RANGE_1000DPS);
  562.     if (ret>0) {
  563.         return 1;
  564.     }

  566.     ret = LSM6DSL_gyro_set_odr(LSM6DSL_GYRO_DEFAULT_ODR_100HZ);
  567.     if (ret>0) {
  568.         return 1;
  569.     }
  570.     printf("successfully LSM6DSL gyro open\r\n");
  571.     return 0;
  572. }

  574. uint8_t LSM6DSL_gyro_st_close(void)
  575. {
  576.         uint8_t ret = 0;
  577.     ret        = LSM6DSL_gyro_power_mode(DEV_POWER_OFF);
  578.     if (ret>0) {
  579.         return 1;
  580.     }
  581.     printf("successfully LSM6DSL gyro close\r\n");
  582.     return 0;
  583. }

  585. void LSM6DSL_init()
  586. {
  587.         if(LSM6DSL_ID_check()>0)
  588.                 return;
  589.         if(LSM6DSL_soft_reset()>0)
  590.                 return;
  591.         if(LSM6DSL_acc_power_mode(DEV_POWER_OFF)>0)
  592.                 return;
  593.     if(LSM6DSL_gyro_power_mode(DEV_POWER_OFF)>0)
  594.                 return;
  595.         printf("successfully LSM6DSL init\r\n");
  596. }

  598. #define DATA_AXIS_X 0
  599. #define DATA_AXIS_Y 1
  600. #define DATA_AXIS_Z 2

  602. uint8_t LSM6DSL_acc_read(int32_t *x_data,int32_t *y_data,int32_t *z_data)
  603. {
  604.         HAL_StatusTypeDef hi2c2_status = 0x00;
  605.         /*read 0X28,0X29,0X2A,0X2B,0X2C,0X2D*/
  606.         uint8_t addr[6] = {LSM6DSL_ACC_GYRO_OUTX_L_XL,LSM6DSL_ACC_GYRO_OUTX_H_XL,
  607.                         LSM6DSL_ACC_GYRO_OUTY_L_XL,LSM6DSL_ACC_GYRO_OUTY_H_XL,
  608.                         LSM6DSL_ACC_GYRO_OUTZ_L_XL,LSM6DSL_ACC_GYRO_OUTZ_H_XL};
  609.         uint8_t val[6] = {0};
  610.         for(uint8_t i=0; i<6; i++){
  611.                 hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr[i],1,&val[i],1,1000);
  612.                 if(HAL_OK!=hi2c2_status){
  613.                         printf("get LSM6DSL acc_read[0X%02X] error\r\n",addr[i]);
  614.                         return 1;
  615.                 }
  616.         }
  617.         printf("read acc reg_data 1:%02X, 2:%02X, 3:%02X, 4:%02X, 5:%02X ,6:%02X\r\n"
  618.                                     ,val[0],val[1],val[2],val[3],val[4],val[5]);
  619.         int32_t data[3] = {0};
  620.         data[DATA_AXIS_X] = (int16_t)((((int16_t)((int8_t)val[1])) << LSM6DSL_SHIFT_EIGHT_BITS) | (val[0]));
  621.         data[DATA_AXIS_Y] = (int16_t)((((int16_t)((int8_t)val[3])) << LSM6DSL_SHIFT_EIGHT_BITS) | (val[2]));
  622.         data[DATA_AXIS_Z] = (int16_t)((((int16_t)((int8_t)val[5])) << LSM6DSL_SHIFT_EIGHT_BITS) | (val[4]));
  623.     if (cur_acc_factor != 0)
  624.     {
  625.         data[DATA_AXIS_X] = (data[DATA_AXIS_X] * cur_acc_factor) / LSM6DSL_ACC_MUL;
  626.         data[DATA_AXIS_Y] = (data[DATA_AXIS_Y] * cur_acc_factor) / LSM6DSL_ACC_MUL;
  627.         data[DATA_AXIS_Z] = (data[DATA_AXIS_Z] * cur_acc_factor) / LSM6DSL_ACC_MUL;
  628.     }
  629.     printf("read acc cur_acc_factor:%ld, X:%ld,Y:%ld,Z:%ld\r\n"
  630.                     ,cur_acc_factor,data[0],data[1],data[2]);
  631.     *x_data = data[DATA_AXIS_X];
  632.     *y_data = data[DATA_AXIS_Y];
  633.     *z_data = data[DATA_AXIS_Z];
  634.         return 0;
  635. }

  637. uint8_t LSM6DSL_gyro_read(int32_t *x_data,int32_t *y_data,int32_t *z_data)
  638. {
  639.         HAL_StatusTypeDef hi2c2_status = 0x00;
  640.         /*read 0X22,0X23,0X24,0X25,0X26,0X27*/
  641.         uint8_t addr[6] = {LSM6DSL_ACC_GYRO_OUTX_L_G,LSM6DSL_ACC_GYRO_OUTX_H_G,
  642.                         LSM6DSL_ACC_GYRO_OUTY_L_G,LSM6DSL_ACC_GYRO_OUTY_H_G,
  643.                         LSM6DSL_ACC_GYRO_OUTZ_L_G,LSM6DSL_ACC_GYRO_OUTZ_H_G};
  644.         uint8_t val[6] = {0};
  645.         for(uint8_t i=0; i<6; i++){
  646.                 hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,LSM6DSL_I2C_ADDR,addr[i],1,&val[i],1,1000);
  647.                 if(HAL_OK!=hi2c2_status){
  648.                         printf("get LSM6DSL gyro_read[0X%02X] error\r\n",addr[i]);
  649.                         return 1;
  650.                 }
  651.         }
  652.         printf("read gyro reg_data 1:%02X, 2:%02X, 3:%02X, 4:%02X, 5:%02X ,6:%02X\r\n"
  653.                             ,val[0],val[1],val[2],val[3],val[4],val[5]);
  654.         int32_t data[3] = {0};
  655.         data[DATA_AXIS_X] = (int16_t)((((int32_t)((int8_t)val[1])) << LSM6DSL_SHIFT_EIGHT_BITS) | (val[0]));
  656.         data[DATA_AXIS_Y] = (int16_t)((((int32_t)((int8_t)val[3])) << LSM6DSL_SHIFT_EIGHT_BITS) | (val[2]));
  657.         data[DATA_AXIS_Z] = (int16_t)((((int32_t)((int8_t)val[5])) << LSM6DSL_SHIFT_EIGHT_BITS) | (val[4]));

  659.     if (cur_gyro_factor != 0) {
  660.         data[DATA_AXIS_X] = (data[DATA_AXIS_X] * cur_gyro_factor) / LSM6DSL_GYRO_MUL;
  661.         data[DATA_AXIS_Y] = (data[DATA_AXIS_Y] * cur_gyro_factor) / LSM6DSL_GYRO_MUL;
  662.         data[DATA_AXIS_Z] = (data[DATA_AXIS_Z] * cur_gyro_factor) / LSM6DSL_GYRO_MUL;
  663.     }
  664.     printf("read gyro cur_gyro_factor:%ld, X:%ld,Y:%ld,Z:%ld\r\n"
  665.                     ,cur_gyro_factor,data[0],data[1],data[2]);
  666.     *x_data = data[DATA_AXIS_X];
  667.     *y_data = data[DATA_AXIS_Y];
  668.     *z_data = data[DATA_AXIS_Z];
  669.         return 0;
  670. }
复制代码

九、MMC3680KJ传感器（三轴磁传感器）
        在ICore源目录下，创建MMC3680KJ文件夹，并在该目录下创建MMC3680KJ.h和MMC3680KJ.c源文件。

        同样在网上查找及下载了MMC3680KJ数据手册，逐项分析，MMC3680KJ设备的I2C通信同样采用从机设备地址+寄存器地址+数据的模式，该设备的从机地址0X60（0X30(00110000)<<1）如下：

 c5218cb2acb14de896da54db86b0ff52.png


         2)寄存器地址总表，设备产品ID地址是0X2F，设备状态地址是0X07，0X00~0X05共6字节，表示三个轴向数值，0X06是设备作业温度值。0X08~0X0A是三个CTRL标识。

 981b4d85fc674003bf1e9521c17a4077.png

         3）三轴向数据值每2个字节表示一个轴向，最低有效位在前。

 4ae3b022940047e0bc1650526aff5ba8.png

         4）作业温度，一个字节数据，给出范围及换算方法

 a37c720e239342ef8b1ef6e6d730d3de.png

         5）设备状态获取，读取数据前，需要明确设备状态

 f7a07b8796b2439ba434e513cb0bad3f.png

         6）control01地址0X08，主要设置设备set和reset，实现设备启用。

 a21c9337abc94589bc015bb4d16b0954.png

         7）control02地址0X09，主要设置设备ODR和OTP。

 c1da457cea3f40a8847b2084aa736264.png

f5d307e8392f49df873bc5f1f5f2cab2.png

         8）control03地址0X09，主要设置设备连续测量模式下频率，脉冲宽度。

 2192a5344ddd44debb2b4727a4e73590.png

         9）设备产品ID验证，寄存器地址是0X2F，正确返回值是0X0A（00001010）

 3fdf63f8b42346708a583f6ee3599ab4.png

         10）按以上分析，伪代码设计如下：
  1. MMC3680KJ从设备地址0x60
  2. init:
  3. read status from 从设备地址0x60 寄存器地址0X07
  4. read p_id from 从设备地址0x60 寄存器地址0X2F
  5. 确保p_id==0X0A
  6. 分别write myconf to 从设备地址0x60 寄存器地址0X08 0X09 0X0A ，完成频率、脉冲、启用等设置

  8. 读取数据
  9. 读取数据确保设备已经设置及启用，寄存器地址0X08，myconf|0X08|(0X01或 0X02)
  10. read data1~6 from 从设备地址0x60 寄存器地址0X00~0X05，共六字节数据
  11. 将data1~6 换算处理
  12. read temp from 从设备地址0x60 寄存器地址0X06，一个字节数据
  13. 将temp换算处理
复制代码

         11）按以上分析及伪代码设计，得出MMC3680KJ传感器的MMC3680KJ.h和MMC3680KJ.c源码文件。

        MMC3680KJ.h
  1. #ifndef _MMC3680KJ_H_
  2. #define _MMC3680KJ_H_

  4. #include "main.h"

  6. void mmc3680kj_temp_memsic_init();
  7. void mmc3680kj_mag_memsic_init();

  9. uint8_t mmc3680kj_read_temp_memsic(int32_t *temperature);
  10. uint8_t mmc3680kj_read_mag_memsic(int32_t *xval, int32_t *yval, int32_t *zval);

  12. #endif /* MMC3680KJ_MMC3680KJ_H_ */
复制代码

        MMC3680KJ.c
  1. #include <stdio.h>
  2. #include "MMC3680KJ.h"

  4. extern I2C_HandleTypeDef hi2c4;

  6. #define MMC3680KJ_REG_DATA 0x00
  7. #define MMC3680KJ_REG_XL 0x00
  8. #define MMC3680KJ_REG_XH 0x01
  9. #define MMC3680KJ_REG_YL 0x02
  10. #define MMC3680KJ_REG_YH 0x03
  11. #define MMC3680KJ_REG_ZL 0x04
  12. #define MMC3680KJ_REG_ZH 0x05
  13. #define MMC3680KJ_REG_TEMP 0x06
  14. #define MMC3680KJ_REG_STATUS 0x07
  15. #define MMC3680KJ_REG_CTRL0 0x08
  16. #define MMC3680KJ_REG_CTRL1 0x09
  17. #define MMC3680KJ_REG_CTRL2 0x0a
  18. #define MMC3680KJ_REG_X_THD 0x0b
  19. #define MMC3680KJ_REG_Y_THD 0x0c
  20. #define MMC3680KJ_REG_Z_THD 0x0d
  21. #define MMC3680KJ_REG_SELFTEST 0x0e
  22. #define MMC3680KJ_REG_PASSWORD 0x0f
  23. #define MMC3680KJ_REG_OTPMODE 0x12
  24. #define MMC3680KJ_REG_TESTMODE 0x13
  25. #define MMC3680KJ_REG_SR_PWIDTH 0x20
  26. #define MMC3680KJ_REG_OTP 0x2a
  27. #define MMC3680KJ_REG_PRODUCTID 0x2f

  29. #define MMC3680KJ_CMD_REFILL 0x20
  30. #define MMC3680KJ_CMD_RESET 0x10
  31. #define MMC3680KJ_CMD_SET 0x08
  32. #define MMC3680KJ_CMD_TM_M 0x01
  33. #define MMC3680KJ_CMD_TM_T 0x02
  34. #define MMC3680KJ_CMD_START_MDT 0x04
  35. #define MMC3680KJ_CMD_100HZ 0x00
  36. #define MMC3680KJ_CMD_200HZ 0x01
  37. #define MMC3680KJ_CMD_400HZ 0x02
  38. #define MMC3680KJ_CMD_600HZ 0x03
  39. #define MMC3680KJ_CMD_CM_14HZ 0x01
  40. #define MMC3680KJ_CMD_CM_5HZ 0x02
  41. #define MMC3680KJ_CMD_CM_1HZ 0x04
  42. #define MMC3680KJ_CMD_SW_RST 0x80
  43. #define MMC3680KJ_CMD_PASSWORD 0xe1
  44. #define MMC3680KJ_CMD_OTP_OPER 0x11
  45. #define MMC3680KJ_CMD_OTP_MR 0x80
  46. #define MMC3680KJ_CMD_OTP_ACT 0x80
  47. #define MMC3680KJ_CMD_OTP_NACT 0x00
  48. #define MMC3680KJ_CMD_STSET_OPEN 0x02
  49. #define MMC3680KJ_CMD_STRST_OPEN 0x04
  50. #define MMC3680KJ_CMD_ST_CLOSE 0x00
  51. #define MMC3680KJ_CMD_INT_MD_EN 0x40
  52. #define MMC3680KJ_CMD_INT_MDT_EN 0x20

  54. #define MMC3680KJ_PRODUCT_ID 0x0a
  55. #define MMC3680KJ_OTP_READ_DONE_BIT 0x10
  56. #define MMC3680KJ_PUMP_ON_BIT 0x08
  57. #define MMC3680KJ_MDT_BIT 0x04
  58. #define MMC3680KJ_MEAS_T_DONE_BIT 0x02
  59. #define MMC3680KJ_MEAS_M_DONE_BIT 0x01

  61. #define MMC3680KJ_I2C_SLAVE_ADDR 0x30
  62. #define MMC3680KJ_ADDR_TRANS(n) ((n) << 1)
  63. #define MMC3680KJ_I2C_ADDR MMC3680KJ_ADDR_TRANS(MMC3680KJ_I2C_SLAVE_ADDR)

  65. #define MMC3680KJ_OFFSET 32768
  66. #define MMC3680KJ_SENSITIVITY 1024000
  67. #define MMC3680KJ_T_ZERO -75
  68. #define MMC3680KJ_T_SENSITIVITY 80

  70. #define MMC3680KJ_MAG_DATA_SIZE 6
  71. #define OTP_CONVERT(REG) (((REG) >= 32 ? (32 - (REG)) : (REG)) * 6)

  73. typedef enum
  74. {
  75.     FLAG_INIT_MAG = 0,
  76.     FLAG_INIT_TEMP,
  77. } FLAG_INIT_BIT;

  79. static int32_t g_otp_matrix[3] = { 1000000, 1000000, 1350000 };

  81. uint8_t mmc3680kj_check_otp()
  82. {
  83.         HAL_StatusTypeDef hi2c2_status = 0x00;
  84.         uint8_t addr_val[3] = {MMC3680KJ_REG_STATUS,0x00,MMC3680KJ_OTP_READ_DONE_BIT};
  85.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  86.         if(HAL_OK!=hi2c2_status){
  87.                 printf("get mmc3680kj opt error\r\n");
  88.                 return 1;
  89.         }
  90.         if ((addr_val[1] & addr_val[2]) != addr_val[2]) {
  91.                 printf("mmc3680kj opt is error\r\n");
  92.         return 1;
  93.     }
  94.         printf("mmc3680kj opt:%02X\r\n",addr_val[1]);
  95.         return 0;
  96. }

  98. uint8_t mmc3680kj_id_check()
  99. {
  100.         HAL_StatusTypeDef hi2c2_status = 0x00;
  101.         uint8_t addr_val[3] = {MMC3680KJ_REG_PRODUCTID,0x00,MMC3680KJ_PRODUCT_ID};
  102.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  103.         if(HAL_OK!=hi2c2_status){
  104.                 printf("get mmc3680kj ID error\r\n");
  105.                 return 1;
  106.         }
  107.         if(addr_val[1]!=addr_val[2]){
  108.                 printf("mmc3680kj validate_id is error\r\n");
  109.                 return 1;
  110.         }
  111.         printf("mmc3680kj_id:%02X\r\n",addr_val[1]);
  112.         return 0;
  113. }

  115. uint8_t mmc3680kj_set_comp_matrix()
  116. {
  117.         HAL_StatusTypeDef hi2c2_status = 0x00;
  118.         /*first*/
  119.         uint8_t addr_val[6][2] = {
  120.                         {MMC3680KJ_REG_PASSWORD,MMC3680KJ_CMD_PASSWORD},
  121.                         {MMC3680KJ_REG_OTPMODE,MMC3680KJ_CMD_OTP_OPER},
  122.                         {MMC3680KJ_REG_TESTMODE,MMC3680KJ_CMD_OTP_MR},
  123.                         {MMC3680KJ_REG_CTRL2,MMC3680KJ_CMD_OTP_ACT},
  124.                         {MMC3680KJ_REG_OTP,0X00},
  125.                         {MMC3680KJ_REG_CTRL2,MMC3680KJ_CMD_OTP_NACT}
  126.         };
  127.         for(uint8_t i=0; i<4; i++)
  128.         {
  129.                 hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[i][0],1,&addr_val[i][1],1,1000);
  130.                 if(HAL_OK!=hi2c2_status){
  131.                         printf("mmc3680kj comp_matrix addr(0X%02X) error\r\n",addr_val[i][0]);
  132.                         return 1;
  133.                 }
  134.         }
  135.         uint8_t reg_data[2] = { 0 };
  136.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[4][0],1,reg_data,2,1000);
  137.         if(HAL_OK!=hi2c2_status){
  138.                 printf("mmc3680kj comp_matrix addr(0X%02X) error\r\n",addr_val[4][0]);
  139.                 return 1;
  140.         }
  141.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[5][0],1,&addr_val[5][1],1,1000);
  142.         if(HAL_OK!=hi2c2_status){
  143.                 printf("mmc3680kj comp_matrix addr(0X%02X) error\r\n",addr_val[5][0]);
  144.                 return 1;
  145.         }
  146.         g_otp_matrix[0] = 1000000;
  147.         g_otp_matrix[1] = OTP_CONVERT(reg_data[0] & 0x3f) * 1000 + 1000000;
  148.         g_otp_matrix[2] = (OTP_CONVERT((reg_data[1] & 0x0f) << 2 | (reg_data[0] & 0xc0) >> 6) +        1000) * 1350;
  149.         return 0;
  150. }

  152. uint8_t mmc3680kj_set_pulse_width()
  153. {
  154.         HAL_StatusTypeDef hi2c2_status = 0x00;
  155.         /*first*/
  156.         uint8_t addr_val[3][2] = {
  157.                         {MMC3680KJ_REG_CTRL2,MMC3680KJ_CMD_OTP_NACT},
  158.                         {MMC3680KJ_REG_PASSWORD,MMC3680KJ_CMD_PASSWORD},
  159.                         {MMC3680KJ_REG_SR_PWIDTH,0X00}
  160.                 };
  161.         for(uint8_t i=0; i<2; i++)
  162.         {
  163.                 hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[i][0],1,&addr_val[i][1],1,1000);
  164.                 if(HAL_OK!=hi2c2_status){
  165.                         printf("mmc3680kj set pulse_width addr(0X%02X) error\r\n",addr_val[i][0]);
  166.                         return 1;
  167.                 }
  168.         }
  169.         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[2][0],1,&addr_val[2][1],1,1000);
  170.         if(HAL_OK!=hi2c2_status){
  171.                 printf("mmc3680kj set pulse_width addr(0X%02X) error\r\n",addr_val[2][0]);
  172.                 return 1;
  173.         }
  174.         addr_val[2][1] &= 0xe7;
  175.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[2][0],1,&addr_val[2][1],1,1000);
  176.         if(HAL_OK!=hi2c2_status){
  177.                 printf("mmc3680kj set pulse_width addr(0X%02X) error\r\n",addr_val[2][0]);
  178.                 return 1;
  179.         }
  180.         printf("successfully mmc3680kj set pulse_width\r\n");
  181.         return 0;
  182. }

  184. uint8_t mmc3680kj_set_output_resolution()
  185. {
  186.         //MMC3680KJ_CMD_100HZ
  187.         HAL_StatusTypeDef hi2c2_status = 0x00;
  188.         uint8_t addr_val[2] = {MMC3680KJ_REG_CTRL1,MMC3680KJ_CMD_100HZ};
  189.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  190.         if(HAL_OK!=hi2c2_status){
  191.                 printf("mmc3680kj set output_resolution addr(0X%02X) error\r\n",addr_val[0]);
  192.                 return 1;
  193.         }
  194.         printf("successfully mmc3680kj set pulse_width\r\n");
  195.         return 0;
  196. }

  198. uint8_t mmc3680kj_set()
  199. {
  200.         HAL_StatusTypeDef hi2c2_status = 0x00;
  201.         uint8_t addr_val[2] = {MMC3680KJ_REG_CTRL0,MMC3680KJ_CMD_SET};
  202.         hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  203.         if(HAL_OK!=hi2c2_status){
  204.                 printf("mmc3680kj set addr(0X%02X) error\r\n",addr_val[0]);
  205.                 return 1;
  206.         }
  207.         printf("successfully mmc3680kj set\r\n");
  208.         return 0;
  209. }

  211. uint8_t mmc3680kj_enable(FLAG_INIT_BIT flag)
  212. {
  213.         HAL_StatusTypeDef hi2c2_status = 0x00;
  214.         if (flag == FLAG_INIT_MAG) {
  215.                 uint8_t addr_val[2] = {MMC3680KJ_REG_CTRL0,MMC3680KJ_CMD_TM_M};
  216.                 hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  217.                 if(HAL_OK!=hi2c2_status){
  218.                         printf("mmc3680kj enable addr(0X%02X) error\r\n",addr_val[0]);
  219.                         return 1;
  220.                 }
  221.                 uint8_t value = 0;
  222.                 do{
  223.                         HAL_Delay(10);
  224.                         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,MMC3680KJ_I2C_ADDR,MMC3680KJ_REG_STATUS,1,&value,1,1000);
  225.                         if(HAL_OK!=hi2c2_status){
  226.                                 printf("mmc3680kj enable addr(0X%02X) error\r\n",MMC3680KJ_REG_STATUS);
  227.                                 return 1;
  228.                         }
  229.                 }while ((value & 0x01) != 0x01);
  230.         }else if(flag==FLAG_INIT_TEMP){
  231.                 uint8_t addr_val[2] = {MMC3680KJ_REG_CTRL0,MMC3680KJ_CMD_TM_T};
  232.                 hi2c2_status = HAL_I2C_Mem_Write(&hi2c4,MMC3680KJ_I2C_ADDR,addr_val[0],1,&addr_val[1],1,1000);
  233.                 if(HAL_OK!=hi2c2_status){
  234.                         printf("mmc3680kj enable addr(0X%02X) error\r\n",addr_val[0]);
  235.                         return 1;
  236.                 }
  237.                 uint8_t value = 0;
  238.                 do{
  239.                         HAL_Delay(10);
  240.                         hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,MMC3680KJ_I2C_ADDR,MMC3680KJ_REG_STATUS,1,&value,1,1000);
  241.                         if(HAL_OK!=hi2c2_status){
  242.                                 printf("mmc3680kj enable addr(0X%02X) error\r\n",MMC3680KJ_REG_STATUS);
  243.                                 return 1;
  244.                         }
  245.                 }while ((value & 0x02) != 0x02);
  246.         }else{
  247.                 return 1;
  248.         }
  249.         printf("successfully mmc3680kj enable\r\n");
  250.         return 0;
  251. }

  253. static int mmc3680kj_tick()
  254. {
  255.     static uint32_t last_time = 0;
  256.     uint32_t        now_time  = 0;

  258.     now_time = HAL_GetTick();
  259.     if (now_time - last_time > 5000) {
  260.         last_time = now_time;
  261.         return 1;
  262.     }

  264.     return 0;
  265. }

  267. uint8_t mmc3680kj_read_temp_memsic(int32_t *temperature)
  268. {
  269.         uint8_t ret = mmc3680kj_enable(FLAG_INIT_TEMP);
  270.         if (ret>0) {
  271.         return ret;
  272.     }
  273.         uint8_t reg_raw = 0;
  274.         HAL_StatusTypeDef hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,MMC3680KJ_I2C_ADDR
  275.                                 ,MMC3680KJ_REG_TEMP,1,®_raw,1,1000);
  276.         if(HAL_OK!=hi2c2_status){
  277.                 printf("mmc3680kj read_mag_memsic addr(0X%02X) error\r\n",MMC3680KJ_REG_STATUS);
  278.                 return 1;
  279.         }
  280.         printf("mmc3680kj_read_temp org:%02X\r\n",reg_raw);
  281.         *temperature = ((int32_t)reg_raw) * MMC3680KJ_T_SENSITIVITY / 100 + MMC3680KJ_T_ZERO;
  282.         printf("mmc3680kj_read_temp:%ld\r\n",*temperature);
  283.         return 0;
  284. }

  286. uint8_t mmc3680kj_read_mag_memsic(int32_t *xval, int32_t *yval, int32_t *zval)
  287. {
  288.         uint8_t ret = 0;
  289.         if (mmc3680kj_tick()) {
  290.         ret = mmc3680kj_set();
  291.         if (ret>0) {
  292.             return ret;
  293.         }
  294.     }
  295.         ret = mmc3680kj_enable(FLAG_INIT_MAG);
  296.         if (ret>0) {
  297.         return ret;
  298.     }
  299.         uint8_t reg_raw[MMC3680KJ_MAG_DATA_SIZE] = { 0 };
  300.         HAL_StatusTypeDef hi2c2_status = HAL_I2C_Mem_Read(&hi2c4,MMC3680KJ_I2C_ADDR
  301.                         ,MMC3680KJ_REG_DATA,1,reg_raw,MMC3680KJ_MAG_DATA_SIZE,1000);
  302.         if(HAL_OK!=hi2c2_status){
  303.                 printf("mmc3680kj read_mag_memsic addr(0X%02X) error\r\n",MMC3680KJ_REG_STATUS);
  304.                 return 1;
  305.         }
  306.     uint16_t    data_raw[3] = { 0 };
  307.     uint32_t    mag_raw[3]  = { 0 };
  308.     data_raw[0] = (uint16_t)(reg_raw[1] << 8 | reg_raw[0]);
  309.     data_raw[1] = (uint16_t)(reg_raw[3] << 8 | reg_raw[2]);
  310.     data_raw[2] = (uint16_t)(reg_raw[5] << 8 | reg_raw[4]);
  311.     mag_raw[0]  = (uint32_t)(data_raw[0]);
  312.     mag_raw[1]  = (uint32_t)(data_raw[1] - data_raw[2] + MMC3680KJ_OFFSET);
  313.     mag_raw[2]  = (uint32_t)(data_raw[1] + data_raw[2] - MMC3680KJ_OFFSET);

  315.     *xval = (int32_t)(mag_raw[0] - MMC3680KJ_OFFSET) * g_otp_matrix[0] / MMC3680KJ_SENSITIVITY;
  316.     *yval = (int32_t)(mag_raw[1] - MMC3680KJ_OFFSET) * g_otp_matrix[1] / MMC3680KJ_SENSITIVITY;
  317.     *zval = (int32_t)(mag_raw[2] - MMC3680KJ_OFFSET) * g_otp_matrix[2] / MMC3680KJ_SENSITIVITY;
  318.     printf("mmc3680kj_read_mag:%ld,%ld,%ld\r\n",*xval,*yval,*zval);
  319.         return 0;
  320. }

  322. void mmc3680kj_temp_memsic_init()
  323. {
  324.         if(mmc3680kj_check_otp()>0)
  325.                 return ;
  326.         if(mmc3680kj_id_check()>0)
  327.                 return ;
  328.         printf("successfully mmc3680kj temp_memsic_init\r\n");
  329. }

  331. void mmc3680kj_mag_memsic_init()
  332. {
  333.         if(mmc3680kj_check_otp()>0)
  334.                 return ;
  335.         if(mmc3680kj_id_check()>0)
  336.                 return ;
  337.         if(mmc3680kj_set_comp_matrix()>0)
  338.                 return ;
  339.         if(mmc3680kj_set_pulse_width()>0)
  340.                 return ;
  341.         if(mmc3680kj_set_output_resolution()>0)
  342.                 return ;
  343.         printf("successfully mmc3680kj mag_memsic_init\r\n");
  344. }
复制代码

十、驱动代码调用及数据采集与展示
        在main.c函数中，调用各个传感器驱动的头文件及调试、oled显示的头文件
  1. /* USER CODE BEGIN Includes */
  2. #include "../../ICore/key/key.h"
  3. #include "../../ICore/led/led.h"
  4. #include "../../ICore/print/print.h"
  5. #include "../../ICore/usart/usart.h"
  6. #include "../../ICore/oled/oled.h"
  7. #include "../../ICore/SHTC1/SHTC1.h"
  8. #include "../../ICore/LTR-553ALS-WA/LTR-553ALS-WA.h"
  9. #include "../../ICore/bmp280/bmp280.h"
  10. #include "../../ICore/LSM6DSL/LSM6DSL.h"
  11. #include "../../ICore/MMC3680KJ/MMC3680KJ.h"
  12. /* USER CODE END Includes */
复制代码

        在主函数中，逐个初始化各个传感器及相关接口，并将OLED设置为蓝色背景显示。
  1. /* USER CODE BEGIN 1 */
  2.     float humidity, temperature;
  3.     uint32_t als_data,ps_data;
  4.     uint32_t comp_temp,comp_baro;
  5.     int32_t acc_x,acc_y,acc_z;
  6.     int32_t gyro_x,gyro_y,gyro_z;
  7.     int32_t mmc_temp,mmc_aval,mmc_bval,mmc_cval;
  8.   /* USER CODE END 1 */
  9. ...........................................
  10.   /* USER CODE BEGIN 2 */
  11.   ResetPrintInit(&hlpuart1);
  12.   HAL_UART_Receive_IT(&hlpuart1,(uint8_t *)&HLPUSART_NewData, 1); //再开启接收中断
  13.   HLPUSART_RX_STA = 0;
  14.   //oled
  15.   OLED_init();
  16.   //shtc1
  17.   humidity = temperature = 0.0;
  18.   als_data = ps_data = 0;
  19.   shtc1_init();
  20.   //ltr553
  21.   LTR_ALS_init();
  22.   ltr553_als_open();
  23.   LTR_PS_init();
  24.   ltr553_ps_open();
  25.   //bmp280
  26.   BMP280_init();
  27.   bmp280_open();
  28.   comp_temp = comp_baro = 0;
  29.   //mmc3680
  30.   mmc3680kj_temp_memsic_init();
  31.   mmc3680kj_mag_memsic_init();
  32.   //
  33.   LSM6DSL_init();
  34.   LSM6DSL_acc_st_open();
  35.   LSM6DSL_gyro_st_open();
  36.   acc_x = acc_y = acc_z = 0;
  37.   gyro_x = gyro_y = gyro_z = 0;
  38.   mmc_temp = mmc_aval = mmc_bval = mmc_cval =0;
  39.   uint8_t menu = 0;
  40.   //设置OLED蓝色背景显示
  41.   BSP_LCD_Clear_DMA(LCD_DISP_BLUE);
  42.   printf("OLED_Clear_DMA\r\n");
  43.   /* USER CODE END 2 */
复制代码

        在主函数循环中，加入对各个传感器数据读取以及显示输出，设置了一个菜单标识menu，按键可以改变它：按键KEY0清屏，按键KEY1实现I2C2接口读取（stch1、ltr553、bmp280）数据及显示；按键KEY2实现I2C4接口读取(LSM6DSL、MMC3680KJ)数据及显示。
  1. /* USER CODE BEGIN WHILE */
  2.   while (1)
  3.   {
  4.           if(HLPUSART_RX_STA&0xC000){//溢出或换行，重新开始
  5.                     //printf("%.*s\r\n",HLPUSART_RX_STA&0X0FFF, HLPUSART_RX_BUF);
  6.                     OLED_printf(10,10,"%.*s",HLPUSART_RX_STA&0X0FFF, HLPUSART_RX_BUF);
  7.                     HLPUSART_RX_STA=0;//接收错误,重新开始
  8.                     HAL_Delay(100);//等待
  9.             }
  10.           if(KEY_0())
  11.           {
  12.                   BSP_LCD_Clear_DMA(LCD_DISP_BLUE);
  13.                   printf("OLED_Clear_DMA\r\n");
  14.           }
  15.           if(KEY_1())
  16.           {
  17.                   if(menu&0x02)
  18.                           BSP_LCD_Clear_DMA(LCD_DISP_BLUE);
  19.                   if(menu&0x01)
  20.                           menu &= 0XFE;        //取消I2C2数据刷新
  21.                   else
  22.                           menu |= 0X01; //开启I2C2数据刷新
  23.                   menu &= 0XFD; //取消I2C4数据刷新

  25.           }
  26.           if(KEY_2())
  27.           {
  28.                   if(menu&0x01)
  29.                           BSP_LCD_Clear_DMA(LCD_DISP_BLUE);

  31.                   if(menu&0x02)
  32.                           menu &= 0XFD; //取消I2C4数据刷新
  33.                   else
  34.                           menu |= 0X02; //开启I2C4数据刷新
  35.                   menu &= 0XFE;        //取消I2C2数据刷新

  37.           }
  38.           if(menu&0x01)
  39.             {
  40.                   /* 读取温湿度数据 */
  41.                     read_ht(&humidity,&temperature);
  42.                     //oled
  43.                     OLED_printf(10,10,"humidity   : %d.%d",(int)humidity, (int)(humidity * 100) % 100);
  44.                     if( temperature >= 0 )
  45.                             OLED_printf(10,26,"temperature: %d.%d",(int)temperature, (int)(temperature * 100) % 100);
  46.                     else
  47.                             OLED_printf(10,26,"temperature: %d.%d",(int)temperature, (int)(-temperature * 100) % 100);
  48.                   read_als(&als_data);
  49.                   read_ps(&ps_data);
  50.                   //
  51.                   OLED_printf(10,42,"light_data : %d.%d",(int)als_data, (int)(als_data * 100) % 100);
  52.                   OLED_printf(10,58,"proximity  : %d.%d",(int)ps_data, (int)(ps_data * 100) % 100);
  53.                   //
  54.                   read_bmp280_temp(&comp_temp);
  55.                   read_bmp280_baro(&comp_baro);
  56.                   OLED_printf(10,74,"comp_DegC  : %d.%d",(int)comp_temp/100,(int)comp_temp%100);
  57.                   OLED_printf(10,90,"comp_baro  : %d.%d",(int)comp_baro/100,(int)comp_baro%100);
  58.             }
  59.             if(menu&0x02)
  60.             {
  61.                   LSM6DSL_acc_read(&acc_x,&acc_y,&acc_z);
  62.                   LSM6DSL_gyro_read(&gyro_x,&gyro_y,&gyro_z);
  63.                   if(acc_x>0)
  64.                           OLED_printf(10,10,"st_acc_x   : %d.%d    ",(acc_x*98)/10000,((acc_x*98)%10000)/100);
  65.                   else
  66.                           OLED_printf(10,10,"st_acc_x   : %d.%d    ",(acc_x*98)/10000,((-acc_x*98)%10000)/100);
  67.                   if(acc_y>0)
  68.                           OLED_printf(10,26,"st_acc_y   : %d.%d    ",(acc_y*98)/10000,((acc_y*98)%10000)/100);
  69.                   else
  70.                           OLED_printf(10,26,"st_acc_y   : %d.%d    ",(acc_y*98)/10000,((-acc_y*98)%10000)/100);
  71.                   if(acc_z>0)
  72.                           OLED_printf(10,42,"st_acc_z   : %d.%d    ",(acc_z*98)/10000,((acc_z*98)%10000)/100);
  73.                   else
  74.                           OLED_printf(10,42,"st_acc_z   : %d.%d    ",(acc_z*98)/10000,((-acc_z*98)%10000)/100);
  75.                   if(gyro_x>0)
  76.                           OLED_printf(10,58,"st_gyro_x  : %d.%d    ",(gyro_x)/1000,((gyro_x)%1000)/10);
  77.                   else
  78.                           OLED_printf(10,58,"st_gyro_x  : %d.%d    ",(gyro_x)/1000,((-gyro_x)%1000)/10);
  79.                   if(gyro_y>0)
  80.                           OLED_printf(10,74,"st_gyro_y  : %d.%d    ",(gyro_y)/1000,((gyro_y)%1000)/10);
  81.                   else
  82.                           OLED_printf(10,74,"st_gyro_y  : %d.%d    ",(gyro_y)/1000,((-gyro_y)%1000)/10);
  83.                   if(gyro_z>0)
  84.                           OLED_printf(10,90,"st_gyro_z  : %d.%d    ",(gyro_z)/1000,((gyro_z)%1000)/10);
  85.                   else
  86.                           OLED_printf(10,90,"st_gyro_z  : %d.%d    ",(gyro_z)/1000,((-gyro_z)%1000)/10);
  87.                   mmc3680kj_read_temp_memsic(&mmc_temp);
  88.                   mmc3680kj_read_mag_memsic(&mmc_aval,&mmc_bval,&mmc_cval);
  89.                 OLED_printf(10,106,"mmc_temp   : %d.%d    ",mmc_temp,0);
  90.                 OLED_printf(10,122,"mmc_aval   : %d.%d    ",mmc_aval,0);
  91.                 OLED_printf(10,138,"mmc_bval   : %d.%d    ",mmc_bval,0);
  92.                 OLED_printf(10,154,"mmc_cval   : %d.%d    ",mmc_cval,0);
  93.             }
  94.           Toggle_led0();
  95.     /* USER CODE END WHILE */
复制代码

        程序编译及下载

 0f4c578f6c2647218275dd9c302815e6.png

         初始化打印输出

 abbebceecc09415e8b34bfd7a7539c36.png

         以及oled屏幕显示I2C2读取数据，按键KEY1，将不断刷新，再按一次KEY1将停止刷新

 9fe161f989774fe7a5304646fae65405.png

         以及OLED屏幕显示I2C4读取数据 ，按键KEY2，将不断刷新，再按一次KEY2将停止刷新

 3cba9a360297438380b425efdb9978d2.png

————————————————
版权声明：py_free-物联智能
如有侵权请联系删除




5b6e19539d784a688c7948a9d3f80bf2.png
赞 收藏 评论0 发布时间：2023-4-6 22:05

举报

0个回答

所属标签

相似分享

官网相关资源

关于
意法半导体
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
STM32N6 AI生态系统
STM32MCU,MPU高性能GUI
ST ACEPACK电源模块
意法半导体生物传感器
STM32Cube扩展软件包
关注我们
st-img 微信公众号
st-img 手机版