PQ_Hybrid_Electrical_Equipment_Team / LPS25H_lib

気圧センサLPS25HをI2Cで動かすライブラリ

Dependents:   rocket_logger_sinkan2018_v1 Shock_Alt_Logger_v2_1

LPS25H_lib.cpp@0:4b9b28d45e51, 2018-04-24 (annotated)

Committer:
Sigma884
Date:
Tue Apr 24 12:23:03 2018 +0000
Revision:
0:4b9b28d45e51
2018/4/24 update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Sigma884 0:4b9b28d45e51 1 #include "LPS25H_lib.h"
Sigma884 0:4b9b28d45e51 2 #include "mbed.h"
Sigma884 0:4b9b28d45e51 3 #include "math.h"
Sigma884 0:4b9b28d45e51 4
Sigma884 0:4b9b28d45e51 5 LPS25H_lib :: LPS25H_lib(AD0 ad0, I2C &userI2C){
Sigma884 0:4b9b28d45e51 6 slave = ad0;
Sigma884 0:4b9b28d45e51 7 i2c = &userI2C;
Sigma884 0:4b9b28d45e51 8 }
Sigma884 0:4b9b28d45e51 9
Sigma884 0:4b9b28d45e51 10 void LPS25H_lib :: begin(int drate){
Sigma884 0:4b9b28d45e51 11 cmd_ctrl_reg1[0] = CTRL_REG1;
Sigma884 0:4b9b28d45e51 12 switch(drate){
Sigma884 0:4b9b28d45e51 13 case 0:
Sigma884 0:4b9b28d45e51 14 cmd_ctrl_reg1[1] = 0x80;
Sigma884 0:4b9b28d45e51 15 break;
Sigma884 0:4b9b28d45e51 16
Sigma884 0:4b9b28d45e51 17 case 1:
Sigma884 0:4b9b28d45e51 18 cmd_ctrl_reg1[1] = 0x90;
Sigma884 0:4b9b28d45e51 19 break;
Sigma884 0:4b9b28d45e51 20
Sigma884 0:4b9b28d45e51 21 case 7:
Sigma884 0:4b9b28d45e51 22 cmd_ctrl_reg1[1] = 0xA0;
Sigma884 0:4b9b28d45e51 23 break;
Sigma884 0:4b9b28d45e51 24
Sigma884 0:4b9b28d45e51 25 case 12:
Sigma884 0:4b9b28d45e51 26 cmd_ctrl_reg1[1] = 0xB0;
Sigma884 0:4b9b28d45e51 27 break;
Sigma884 0:4b9b28d45e51 28
Sigma884 0:4b9b28d45e51 29 case 25:
Sigma884 0:4b9b28d45e51 30 cmd_ctrl_reg1[1] = 0xC0;
Sigma884 0:4b9b28d45e51 31 break;
Sigma884 0:4b9b28d45e51 32 }
Sigma884 0:4b9b28d45e51 33
Sigma884 0:4b9b28d45e51 34 i2c -> frequency(400000);
Sigma884 0:4b9b28d45e51 35 i2c -> write(slave, cmd_ctrl_reg1, 2, true);
Sigma884 0:4b9b28d45e51 36 wait(0.5f);
Sigma884 0:4b9b28d45e51 37 }
Sigma884 0:4b9b28d45e51 38
Sigma884 0:4b9b28d45e51 39 void LPS25H_lib :: setFIFO(int size){
Sigma884 0:4b9b28d45e51 40 cmd_ctrl_reg2[0] = CTRL_REG2;
Sigma884 0:4b9b28d45e51 41 cmd_ctrl_reg2[1] = 0x40;
Sigma884 0:4b9b28d45e51 42 cmd_fifo_ctrl[0] = FIFO_CTRL;
Sigma884 0:4b9b28d45e51 43 switch(size){
Sigma884 0:4b9b28d45e51 44 case 0:
Sigma884 0:4b9b28d45e51 45 cmd_ctrl_reg2[1] = 0x00;
Sigma884 0:4b9b28d45e51 46 cmd_fifo_ctrl[1] = 0x00;
Sigma884 0:4b9b28d45e51 47 break;
Sigma884 0:4b9b28d45e51 48
Sigma884 0:4b9b28d45e51 49 case 2:
Sigma884 0:4b9b28d45e51 50 cmd_fifo_ctrl[1] = 0xC1;
Sigma884 0:4b9b28d45e51 51 break;
Sigma884 0:4b9b28d45e51 52
Sigma884 0:4b9b28d45e51 53 case 4:
Sigma884 0:4b9b28d45e51 54 cmd_fifo_ctrl[1] = 0xC3;
Sigma884 0:4b9b28d45e51 55 break;
Sigma884 0:4b9b28d45e51 56
Sigma884 0:4b9b28d45e51 57 case 8:
Sigma884 0:4b9b28d45e51 58 cmd_fifo_ctrl[1] = 0xC7;
Sigma884 0:4b9b28d45e51 59 break;
Sigma884 0:4b9b28d45e51 60
Sigma884 0:4b9b28d45e51 61 case 16:
Sigma884 0:4b9b28d45e51 62 cmd_fifo_ctrl[1] = 0xCF;
Sigma884 0:4b9b28d45e51 63 break;
Sigma884 0:4b9b28d45e51 64
Sigma884 0:4b9b28d45e51 65 case 32:
Sigma884 0:4b9b28d45e51 66 cmd_fifo_ctrl[1] = 0xDF;
Sigma884 0:4b9b28d45e51 67 break;
Sigma884 0:4b9b28d45e51 68 }
Sigma884 0:4b9b28d45e51 69
Sigma884 0:4b9b28d45e51 70 i2c -> write(slave, cmd_ctrl_reg2, 2, true);
Sigma884 0:4b9b28d45e51 71 i2c -> write(slave, cmd_fifo_ctrl, 2, true);
Sigma884 0:4b9b28d45e51 72 wait(0.5f);
Sigma884 0:4b9b28d45e51 73 }
Sigma884 0:4b9b28d45e51 74
Sigma884 0:4b9b28d45e51 75 int LPS25H_lib :: whoAmI(){
Sigma884 0:4b9b28d45e51 76 cmd_who_am_i[0] = WHO_AM_I;
Sigma884 0:4b9b28d45e51 77 i2c -> write(slave, cmd_who_am_i, 1, true);
Sigma884 0:4b9b28d45e51 78 i2c -> read(slave | 1, &cmd_who_am_i[0], 1, false);
Sigma884 0:4b9b28d45e51 79 if(cmd_who_am_i[0] == 0xBD){
Sigma884 0:4b9b28d45e51 80 return 0;
Sigma884 0:4b9b28d45e51 81 }
Sigma884 0:4b9b28d45e51 82 else{
Sigma884 0:4b9b28d45e51 83 return -1;
Sigma884 0:4b9b28d45e51 84 }
Sigma884 0:4b9b28d45e51 85 }
Sigma884 0:4b9b28d45e51 86
Sigma884 0:4b9b28d45e51 87 float LPS25H_lib :: getPres(){
Sigma884 0:4b9b28d45e51 88 cmd_p[0] = P_XL;
Sigma884 0:4b9b28d45e51 89 cmd_p[1] = P_L;
Sigma884 0:4b9b28d45e51 90 cmd_p[2] = P_H;
Sigma884 0:4b9b28d45e51 91 for(int c1 = 0; c1 < 3; c1 ++){
Sigma884 0:4b9b28d45e51 92 i2c -> write(slave, &cmd_p[c1], 1, true);
Sigma884 0:4b9b28d45e51 93 i2c -> read(slave | 1, &cmd_p[c1], 1, false);
Sigma884 0:4b9b28d45e51 94 data_p[c1] = (int)cmd_p[c1];
Sigma884 0:4b9b28d45e51 95 }
Sigma884 0:4b9b28d45e51 96 return (float)(data_p[0] | data_p[1] << 8 | data_p[2] << 16) / 4096.0f;
Sigma884 0:4b9b28d45e51 97 }
Sigma884 0:4b9b28d45e51 98
Sigma884 0:4b9b28d45e51 99 float LPS25H_lib :: getTemp(){
Sigma884 0:4b9b28d45e51 100 cmd_t[0] = T_L;
Sigma884 0:4b9b28d45e51 101 cmd_t[1] = T_H;
Sigma884 0:4b9b28d45e51 102 for(int c1 = 0; c1 < 2; c1 ++){
Sigma884 0:4b9b28d45e51 103 i2c -> write(slave, &cmd_t[c1], 1, true);
Sigma884 0:4b9b28d45e51 104 i2c -> read(slave, &cmd_t[c1], 1, false);
Sigma884 0:4b9b28d45e51 105 data_t[c1] = (int)cmd_t[c1];
Sigma884 0:4b9b28d45e51 106 }
Sigma884 0:4b9b28d45e51 107 if(data_t[1] >= 128){
Sigma884 0:4b9b28d45e51 108 return 42.5 - (float)(65536 - (data_t[0] | data_t[1] << 8)) / 480.0f;
Sigma884 0:4b9b28d45e51 109 }
Sigma884 0:4b9b28d45e51 110 else{
Sigma884 0:4b9b28d45e51 111 return 42.5 + (float)(data_t[0] | data_t[1] << 8) / 480.0f;
Sigma884 0:4b9b28d45e51 112 }
Sigma884 0:4b9b28d45e51 113 }
Sigma884 0:4b9b28d45e51 114
Sigma884 0:4b9b28d45e51 115 float LPS25H_lib :: getAlt(float P_0, float T_0){
Sigma884 0:4b9b28d45e51 116 pres_0 = P_0;
Sigma884 0:4b9b28d45e51 117 temp_0 = T_0;
Sigma884 0:4b9b28d45e51 118 pres_now = getPres();
Sigma884 0:4b9b28d45e51 119
Sigma884 0:4b9b28d45e51 120 return -(273.0 + temp_0) / 0.0342 * log(pres_now / pres_0);
Sigma884 0:4b9b28d45e51 121 }