Revision 0:4b9b28d45e51, committed 2018-04-24

Comitter:

Sigma884

Date:

Tue Apr 24 12:23:03 2018 +0000

Commit message:

2018/4/24 update

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/LPS25H_lib.cpp	Tue Apr 24 12:23:03 2018 +0000
@@ -0,0 +1,121 @@
+#include "LPS25H_lib.h"
+#include "mbed.h"
+#include "math.h"
+
+LPS25H_lib :: LPS25H_lib(AD0 ad0, I2C &userI2C){
+    slave = ad0;
+    i2c = &userI2C;
+}
+
+void LPS25H_lib :: begin(int drate){
+    cmd_ctrl_reg1[0] = CTRL_REG1;
+    switch(drate){
+        case 0:
+        cmd_ctrl_reg1[1] = 0x80;
+        break;
+        
+        case 1:
+        cmd_ctrl_reg1[1] = 0x90;
+        break;
+        
+        case 7:
+        cmd_ctrl_reg1[1] = 0xA0;
+        break;
+        
+        case 12:
+        cmd_ctrl_reg1[1] = 0xB0;
+        break;
+        
+        case 25:
+        cmd_ctrl_reg1[1] = 0xC0;
+        break;
+    }
+    
+    i2c -> frequency(400000);
+    i2c -> write(slave, cmd_ctrl_reg1, 2, true);
+    wait(0.5f);
+}
+
+void LPS25H_lib :: setFIFO(int size){
+    cmd_ctrl_reg2[0] = CTRL_REG2;
+    cmd_ctrl_reg2[1] = 0x40;
+    cmd_fifo_ctrl[0] = FIFO_CTRL;
+    switch(size){
+        case 0:
+        cmd_ctrl_reg2[1] = 0x00;
+        cmd_fifo_ctrl[1] = 0x00;
+        break;
+        
+        case 2:
+        cmd_fifo_ctrl[1] = 0xC1;
+        break;
+        
+        case 4:
+        cmd_fifo_ctrl[1] = 0xC3;
+        break;
+        
+        case 8:
+        cmd_fifo_ctrl[1] = 0xC7;
+        break;
+        
+        case 16:
+        cmd_fifo_ctrl[1] = 0xCF;
+        break;
+        
+        case 32:
+        cmd_fifo_ctrl[1] = 0xDF;
+        break;
+    }
+    
+    i2c -> write(slave, cmd_ctrl_reg2, 2, true);
+    i2c -> write(slave, cmd_fifo_ctrl, 2, true);
+    wait(0.5f);
+}
+
+int LPS25H_lib :: whoAmI(){
+    cmd_who_am_i[0] = WHO_AM_I;
+    i2c -> write(slave, cmd_who_am_i, 1, true);
+    i2c -> read(slave | 1, &cmd_who_am_i[0], 1, false);
+    if(cmd_who_am_i[0] == 0xBD){
+        return 0;
+    }
+    else{
+        return -1;
+    }
+}
+
+float LPS25H_lib :: getPres(){
+    cmd_p[0] = P_XL;
+    cmd_p[1] = P_L;
+    cmd_p[2] = P_H;
+    for(int c1 = 0; c1 < 3; c1 ++){
+        i2c -> write(slave, &cmd_p[c1], 1, true);
+        i2c -> read(slave | 1, &cmd_p[c1], 1, false);
+        data_p[c1] = (int)cmd_p[c1];
+    }
+    return (float)(data_p[0] | data_p[1] << 8 | data_p[2] << 16) / 4096.0f;
+}
+
+float LPS25H_lib :: getTemp(){
+    cmd_t[0] = T_L;
+    cmd_t[1] = T_H;
+    for(int c1 = 0; c1 < 2; c1 ++){
+        i2c -> write(slave, &cmd_t[c1], 1, true);
+        i2c -> read(slave, &cmd_t[c1], 1, false);
+        data_t[c1] = (int)cmd_t[c1];
+    }
+    if(data_t[1] >= 128){
+        return 42.5 - (float)(65536 - (data_t[0] | data_t[1] << 8)) / 480.0f;
+    }
+    else{
+        return 42.5 + (float)(data_t[0] | data_t[1] << 8) / 480.0f;
+    }
+}
+
+float LPS25H_lib :: getAlt(float P_0, float T_0){
+    pres_0 = P_0;
+    temp_0 = T_0;
+    pres_now = getPres();
+    
+    return -(273.0 + temp_0) / 0.0342 * log(pres_now / pres_0);
+}
\ No newline at end of file

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/LPS25H_lib.h	Tue Apr 24 12:23:03 2018 +0000
@@ -0,0 +1,67 @@
+#ifndef LPS25H_LIB_H
+#define LPS25H_LIB_H
+
+#include "mbed.h"
+
+#define WHO_AM_I 0x0F
+
+#define CTRL_REG1 0x20
+#define CTRL_REG2 0x21
+#define FIFO_CTRL 0x2E
+
+#define P_XL 0x28
+#define P_L 0x29
+#define P_H 0x2A
+
+#define T_L 0x2B
+#define T_H 0x2C
+
+class LPS25H_lib{
+    
+    public:
+    typedef enum{
+        AD0_LOW = 0xB8,
+        AD0_HIGH = 0xBA
+    }AD0;
+    LPS25H_lib(AD0 ad0, I2C &userI2C);
+    private:
+    char slave;
+    I2C *i2c;
+    
+    public:
+    void begin(int drate);
+    private:
+    char cmd_ctrl_reg1[2];
+    
+    public:
+    void setFIFO(int size);
+    private:
+    char cmd_ctrl_reg2[2];
+    char cmd_fifo_ctrl[2];
+    
+    public:
+    int whoAmI();
+    private:
+    char cmd_who_am_i[1];
+    
+    public:
+    float getPres();
+    private:
+    char cmd_p[3];
+    int data_p[3];
+    
+    public:
+    float getTemp();
+    private:
+    char cmd_t[2];
+    int data_t[2];
+    
+    public:
+    float getAlt(float P_0, float T_0);
+    private:
+    float pres_0;
+    float temp_0;
+    float pres_now;
+};
+
+#endif
\ No newline at end of file