Brian Huey / Mbed 2 deprecated UUU_MultiTech_Dragonfly_Sprint_Rev1

Rev 1.0 4/26/2016 Paul Jaeger - Multitech, Brian Huey - Sprint Changed post interval to 2000ms added temp, analoguv and pressure to http post added alias: TEMP ANALOG-UV PRESSURE concatenated http post, to post all within the same routine and check for error after the post confirmed that data is published to Exosite

Dependencies:   MbedJSONValue mbed mtsas

Fork of UUU_MultiTech_Dragonfly_Sprint by Paul Jaeger

main.cpp@11:d2ac3fa6f2d3, 2016-04-19 (annotated)

Committer:
BlueShadow
Date:
Tue Apr 19 14:21:51 2016 +0000
Revision:
11:d2ac3fa6f2d3
Parent:
10:1c44f9375dd2
Child:
12:9942995476ef
working!!! ;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mfiore 0:a44e71488e1f 1 /*************************************************************************
BlueShadow 8:e78dcfad254b 2 * Dragonfly Example program for 2016 Sprint Exosite Training
BlueShadow 6:7946b5c2376a 3 *
mfiore 0:a44e71488e1f 4 * The following hardware is required to successfully run this program:
mfiore 0:a44e71488e1f 5 * - MultiTech UDK2 (4" square white PCB with Arduino headers, antenna
mfiore 0:a44e71488e1f 6 * connector, micro USB ports, and 40-pin connector for Dragonfly)
mfiore 0:a44e71488e1f 7 * - MultiTech Dragonfly (1"x2" green PCB with Telit radio)
BlueShadow 8:e78dcfad254b 8 * - Rohm Electronics Sensor Board
BlueShadow 8:e78dcfad254b 9
BlueShadow 8:e78dcfad254b 10 * - Expansion board (LSM6DS0
mfiore 0:a44e71488e1f 11 * 3-axis accelerometer + 3-axis gyroscope, LIS3MDL 3-axis
mfiore 0:a44e71488e1f 12 * magnetometer, HTS221 humidity and temperature sensor and LPS25HB
mfiore 0:a44e71488e1f 13 * pressure sensor)
mfiore 0:a44e71488e1f 14 *
mfiore 0:a44e71488e1f 15 * What this program does:
BlueShadow 8:e78dcfad254b 16 * - reads data from all sensors on board
mfiore 0:a44e71488e1f 17 * - prints all sensor data to debug port on a periodic basis
BlueShadow 8:e78dcfad254b 18 * - optionally send data to Exosite
BlueShadow 8:e78dcfad254b 19 * - All data is sent to a specific location determined by the student login.
BlueShadow 8:e78dcfad254b 20 * - Exosite cloud platform (user must create own account and configure a device
BlueShadow 8:e78dcfad254b 21 * - you need to set the "VENDOR" and "MODEL"
BlueShadow 8:e78dcfad254b 22
mfiore 5:a946ef74a8c4 23 * - you need to set the "do_cloud_post" flag to true for this to
mfiore 5:a946ef74a8c4 24 * work
mfiore 0:a44e71488e1f 25 *
mfiore 0:a44e71488e1f 26 * Setup:
mfiore 0:a44e71488e1f 27 * - Correctly insert SIM card into Dragonfly
mfiore 0:a44e71488e1f 28 * - Seat the Dragonfly on the UDK2 board
mfiore 0:a44e71488e1f 29 * - Connect an antenna to the connector on the Dragonfly labled "M"
mfiore 0:a44e71488e1f 30 * - Stack the Base Shield on the UDK2 Arduino headers
mfiore 0:a44e71488e1f 31 * - Stack the MEMs board on top of the Base Shield
mfiore 0:a44e71488e1f 32 * - Plug in the power cable
mfiore 0:a44e71488e1f 33 * - Plug a micro USB cable into the port below and slightly to the
mfiore 0:a44e71488e1f 34 * left of the Dragonfly (NOT the port on the Dragonfly)
mfiore 0:a44e71488e1f 35 *
mfiore 0:a44e71488e1f 36 * Go have fun and make something cool!
mfiore 0:a44e71488e1f 37 *
mfiore 0:a44e71488e1f 38 ************************************************************************/
BlueShadow 6:7946b5c2376a 39 /*
BlueShadow 6:7946b5c2376a 40 Sample Program Description:
BlueShadow 6:7946b5c2376a 41 This Program will enable to Multi-Tech Dragonfly platform to utilize ROHM's Multi-sensor Shield Board.
BlueShadow 6:7946b5c2376a 42 This program will initialize all sensors on the shield and then read back the sensor data.
BlueShadow 6:7946b5c2376a 43 Data will then be output to the UART Debug Terminal every 1 second.
BlueShadow 6:7946b5c2376a 44
BlueShadow 6:7946b5c2376a 45 Sample Program Author:
BlueShadow 6:7946b5c2376a 46 ROHM USDC
BlueShadow 6:7946b5c2376a 47
BlueShadow 6:7946b5c2376a 48 Additional Resources:
BlueShadow 6:7946b5c2376a 49 ROHM Sensor Shield GitHub Repository: https://github.com/ROHMUSDC/ROHM_SensorPlatform_Multi-Sensor-Shield
BlueShadow 6:7946b5c2376a 50 */
BlueShadow 6:7946b5c2376a 51
BlueShadow 6:7946b5c2376a 52
mfiore 0:a44e71488e1f 53 #include "mbed.h"
mfiore 0:a44e71488e1f 54 #include "mtsas.h"
mfiore 0:a44e71488e1f 55 #include <string>
BlueShadow 8:e78dcfad254b 56 #include <sstream>
BlueShadow 8:e78dcfad254b 57
BlueShadow 8:e78dcfad254b 58 #define EXOSITE_CIK "1e05228e50762cc29cf414bc518259a3ab5dc247"
BlueShadow 8:e78dcfad254b 59
BlueShadow 8:e78dcfad254b 60 char EXOSITE_HEADER[] = "X-Exosite-CIK: " EXOSITE_CIK "\r\nAccept: application/x-www-form-urlencoded; charset=utf-8\r\n";
BlueShadow 8:e78dcfad254b 61 const char EXOSITE_URL[] = "https://m2.exosite.com:443/onep:v1/stack/alias";
BlueShadow 8:e78dcfad254b 62
BlueShadow 8:e78dcfad254b 63 DigitalOut Led1Out(LED1);
mfiore 0:a44e71488e1f 64
mfiore 0:a44e71488e1f 65 // Debug serial port
mfiore 0:a44e71488e1f 66 static Serial debug(USBTX, USBRX);
mfiore 0:a44e71488e1f 67
mfiore 0:a44e71488e1f 68 // MTSSerialFlowControl - serial link between processor and radio
mfiore 1:a049d113e250 69 static MTSSerialFlowControl* io;
mfiore 0:a44e71488e1f 70
mfiore 0:a44e71488e1f 71 // Cellular - radio object for cellular operations (SMS, TCP, etc)
mfiore 0:a44e71488e1f 72 Cellular* radio;
mfiore 0:a44e71488e1f 73
mfiore 0:a44e71488e1f 74 // APN associated with SIM card
mfiore 4:730b61258422 75 // this APN should work for the AT&T SIM that came with your Dragonfly
mfiore 4:730b61258422 76 //static const std::string apn = "";
BlueShadow 8:e78dcfad254b 77 static const std::string apn = "b2b.tmobile.com";
mfiore 5:a946ef74a8c4 78
mfiore 5:a946ef74a8c4 79 // set to true if you want to post to the cloud
mfiore 5:a946ef74a8c4 80 //bool do_cloud_post = false;
mfiore 5:a946ef74a8c4 81 bool do_cloud_post = true;
mfiore 5:a946ef74a8c4 82
mfiore 0:a44e71488e1f 83 // variables for sensor data
mfiore 0:a44e71488e1f 84 float temp_celsius;
mfiore 0:a44e71488e1f 85 float humidity_percent;
mfiore 0:a44e71488e1f 86 float pressure_mbar;
mfiore 0:a44e71488e1f 87 float moisture_percent;
mfiore 0:a44e71488e1f 88 int32_t mag_mgauss[3];
mfiore 0:a44e71488e1f 89 int32_t acc_mg[3];
mfiore 0:a44e71488e1f 90 int32_t gyro_mdps[3];
mfiore 0:a44e71488e1f 91
mfiore 0:a44e71488e1f 92 // misc variables
BlueShadow 9:6475e1b83491 93 static char wall_of_dash[] = "--------------------------------------------------";
mfiore 5:a946ef74a8c4 94 static int post_interval_ms = 30000;
mfiore 0:a44e71488e1f 95 int debug_baud = 115200;
mfiore 0:a44e71488e1f 96
BlueShadow 6:7946b5c2376a 97
BlueShadow 6:7946b5c2376a 98
BlueShadow 6:7946b5c2376a 99 /****************************************************************************************************
BlueShadow 6:7946b5c2376a 100
BlueShadow 6:7946b5c2376a 101 ****************************************************************************************************/
BlueShadow 6:7946b5c2376a 102
BlueShadow 6:7946b5c2376a 103 //Macros for checking each of the different Sensor Devices
BlueShadow 6:7946b5c2376a 104 #define AnalogTemp //BDE0600
BlueShadow 6:7946b5c2376a 105 #define AnalogUV //ML8511
BlueShadow 6:7946b5c2376a 106 #define HallSensor //BU52011
BlueShadow 6:7946b5c2376a 107 #define RPR0521 //RPR0521
BlueShadow 6:7946b5c2376a 108 #define KMX62 //KMX61, Accel/Mag
BlueShadow 6:7946b5c2376a 109 #define COLOR //BH1745
BlueShadow 6:7946b5c2376a 110 #define KX022 //KX022, Accel Only
BlueShadow 6:7946b5c2376a 111 #define Pressure //BM1383
BlueShadow 6:7946b5c2376a 112
BlueShadow 6:7946b5c2376a 113
BlueShadow 6:7946b5c2376a 114 //Define Pins for I2C Interface
BlueShadow 6:7946b5c2376a 115 I2C i2c(I2C_SDA, I2C_SCL);
BlueShadow 6:7946b5c2376a 116 bool RepStart = true;
BlueShadow 6:7946b5c2376a 117 bool NoRepStart = false;
BlueShadow 6:7946b5c2376a 118
BlueShadow 6:7946b5c2376a 119 //Define Sensor Variables
BlueShadow 6:7946b5c2376a 120 #ifdef AnalogTemp
BlueShadow 6:7946b5c2376a 121 AnalogIn BDE0600_Temp(PC_4); //Mapped to A2
BlueShadow 6:7946b5c2376a 122 uint16_t BDE0600_Temp_value;
BlueShadow 6:7946b5c2376a 123 float BDE0600_output;
BlueShadow 6:7946b5c2376a 124 #endif
BlueShadow 6:7946b5c2376a 125
BlueShadow 6:7946b5c2376a 126 #ifdef AnalogUV
BlueShadow 6:7946b5c2376a 127 AnalogIn ML8511_UV(PC_1); //Mapped to A4
BlueShadow 6:7946b5c2376a 128 uint16_t ML8511_UV_value;
BlueShadow 6:7946b5c2376a 129 float ML8511_output;
BlueShadow 6:7946b5c2376a 130 #endif
BlueShadow 6:7946b5c2376a 131
BlueShadow 6:7946b5c2376a 132 #ifdef HallSensor
BlueShadow 6:7946b5c2376a 133 DigitalIn Hall_GPIO0(PC_8);
BlueShadow 6:7946b5c2376a 134 DigitalIn Hall_GPIO1(PB_5);
BlueShadow 6:7946b5c2376a 135 int Hall_Return1;
BlueShadow 6:7946b5c2376a 136 int Hall_Return0;
BlueShadow 6:7946b5c2376a 137 int32_t Hall_Return[2];
BlueShadow 6:7946b5c2376a 138 #endif
BlueShadow 6:7946b5c2376a 139
BlueShadow 6:7946b5c2376a 140 #ifdef RPR0521
BlueShadow 6:7946b5c2376a 141 int RPR0521_addr_w = 0x70; //7bit addr = 0x38, with write bit 0
BlueShadow 6:7946b5c2376a 142 int RPR0521_addr_r = 0x71; //7bit addr = 0x38, with read bit 1
BlueShadow 6:7946b5c2376a 143 char RPR0521_ModeControl[2] = {0x41, 0xE6};
BlueShadow 6:7946b5c2376a 144 char RPR0521_ALSPSControl[2] = {0x42, 0x03};
BlueShadow 6:7946b5c2376a 145 char RPR0521_Persist[2] = {0x43, 0x20};
BlueShadow 6:7946b5c2376a 146 char RPR0521_Addr_ReadData = 0x44;
BlueShadow 6:7946b5c2376a 147 char RPR0521_Content_ReadData[6];
BlueShadow 6:7946b5c2376a 148 int RPR0521_PS_RAWOUT = 0; //this is an output
BlueShadow 6:7946b5c2376a 149 float RPR0521_PS_OUT = 0;
BlueShadow 6:7946b5c2376a 150 int RPR0521_ALS_D0_RAWOUT = 0;
BlueShadow 6:7946b5c2376a 151 int RPR0521_ALS_D1_RAWOUT = 0;
BlueShadow 6:7946b5c2376a 152 float RPR0521_ALS_DataRatio = 0;
BlueShadow 6:7946b5c2376a 153 float RPR0521_ALS_OUT = 0; //this is an output
BlueShadow 6:7946b5c2376a 154 float RPR0521_ALS[2]; // is this ok taking an int to the [0] value and float to [1]???????????
BlueShadow 6:7946b5c2376a 155 #endif
BlueShadow 6:7946b5c2376a 156
BlueShadow 6:7946b5c2376a 157 #ifdef KMX62
BlueShadow 6:7946b5c2376a 158 int KMX62_addr_w = 0x1C; //7bit addr = 0x38, with write bit 0
BlueShadow 6:7946b5c2376a 159 int KMX62_addr_r = 0x1D; //7bit addr = 0x38, with read bit 1
BlueShadow 6:7946b5c2376a 160 char KMX62_CNTL2[2] = {0x3A, 0x5F};
BlueShadow 6:7946b5c2376a 161 char KMX62_Addr_Accel_ReadData = 0x0A;
BlueShadow 6:7946b5c2376a 162 char KMX62_Content_Accel_ReadData[6];
BlueShadow 6:7946b5c2376a 163 char KMX62_Addr_Mag_ReadData = 0x10;
BlueShadow 6:7946b5c2376a 164 char KMX62_Content_Mag_ReadData[6];
BlueShadow 6:7946b5c2376a 165 short int MEMS_Accel_Xout = 0;
BlueShadow 6:7946b5c2376a 166 short int MEMS_Accel_Yout = 0;
BlueShadow 6:7946b5c2376a 167 short int MEMS_Accel_Zout = 0;
BlueShadow 6:7946b5c2376a 168 double MEMS_Accel_Conv_Xout = 0;
BlueShadow 6:7946b5c2376a 169 double MEMS_Accel_Conv_Yout = 0;
BlueShadow 6:7946b5c2376a 170 double MEMS_Accel_Conv_Zout = 0;
BlueShadow 6:7946b5c2376a 171
BlueShadow 6:7946b5c2376a 172 short int MEMS_Mag_Xout = 0;
BlueShadow 6:7946b5c2376a 173 short int MEMS_Mag_Yout = 0;
BlueShadow 6:7946b5c2376a 174 short int MEMS_Mag_Zout = 0;
BlueShadow 6:7946b5c2376a 175 float MEMS_Mag_Conv_Xout = 0;
BlueShadow 6:7946b5c2376a 176 float MEMS_Mag_Conv_Yout = 0;
BlueShadow 6:7946b5c2376a 177 float MEMS_Mag_Conv_Zout = 0;
BlueShadow 6:7946b5c2376a 178
BlueShadow 6:7946b5c2376a 179 double MEMS_Accel[3];
BlueShadow 6:7946b5c2376a 180 float MEMS_Mag[3];
BlueShadow 6:7946b5c2376a 181 #endif
BlueShadow 6:7946b5c2376a 182
BlueShadow 6:7946b5c2376a 183 #ifdef COLOR
BlueShadow 6:7946b5c2376a 184 int BH1745_addr_w = 0x72; //write
BlueShadow 6:7946b5c2376a 185 int BH1745_addr_r = 0x73; //read
BlueShadow 6:7946b5c2376a 186 char BH1745_persistence[2] = {0x61, 0x03};
BlueShadow 6:7946b5c2376a 187 char BH1745_mode1[2] = {0x41, 0x00};
BlueShadow 6:7946b5c2376a 188 char BH1745_mode2[2] = {0x42, 0x92};
BlueShadow 6:7946b5c2376a 189 char BH1745_mode3[2] = {0x43, 0x02};
BlueShadow 6:7946b5c2376a 190 char BH1745_Content_ReadData[6];
BlueShadow 6:7946b5c2376a 191 char BH1745_Addr_color_ReadData = 0x50;
BlueShadow 6:7946b5c2376a 192 int BH1745_Red;
BlueShadow 6:7946b5c2376a 193 int BH1745_Blue;
BlueShadow 6:7946b5c2376a 194 int BH1745_Green;
BlueShadow 6:7946b5c2376a 195 int32_t BH1745[3]; //Red, Blue Green matrix
BlueShadow 6:7946b5c2376a 196 #endif
BlueShadow 6:7946b5c2376a 197
BlueShadow 6:7946b5c2376a 198 #ifdef KX022
BlueShadow 6:7946b5c2376a 199 int KX022_addr_w = 0x3C; //write
BlueShadow 6:7946b5c2376a 200 int KX022_addr_r = 0x3D; //read
BlueShadow 6:7946b5c2376a 201 char KX022_Accel_CNTL1[2] = {0x18, 0x41};
BlueShadow 6:7946b5c2376a 202 char KX022_Accel_ODCNTL[2] = {0x1B, 0x02};
BlueShadow 6:7946b5c2376a 203 char KX022_Accel_CNTL3[2] = {0x1A, 0xD8};
BlueShadow 6:7946b5c2376a 204 char KX022_Accel_TILT_TIMER[2] = {0x22, 0x01};
BlueShadow 6:7946b5c2376a 205 char KX022_Accel_CNTL2[2] = {0x18, 0xC1};
BlueShadow 6:7946b5c2376a 206 char KX022_Content_ReadData[6];
BlueShadow 6:7946b5c2376a 207 char KX022_Addr_Accel_ReadData = 0x06;
BlueShadow 6:7946b5c2376a 208 float KX022_Accel_X;
BlueShadow 6:7946b5c2376a 209 float KX022_Accel_Y;
BlueShadow 6:7946b5c2376a 210 float KX022_Accel_Z;
BlueShadow 6:7946b5c2376a 211 short int KX022_Accel_X_RawOUT = 0;
BlueShadow 6:7946b5c2376a 212 short int KX022_Accel_Y_RawOUT = 0;
BlueShadow 6:7946b5c2376a 213 short int KX022_Accel_Z_RawOUT = 0;
BlueShadow 6:7946b5c2376a 214 int KX022_Accel_X_LB = 0;
BlueShadow 6:7946b5c2376a 215 int KX022_Accel_X_HB = 0;
BlueShadow 6:7946b5c2376a 216 int KX022_Accel_Y_LB = 0;
BlueShadow 6:7946b5c2376a 217 int KX022_Accel_Y_HB = 0;
BlueShadow 6:7946b5c2376a 218 int KX022_Accel_Z_LB = 0;
BlueShadow 6:7946b5c2376a 219 int KX022_Accel_Z_HB = 0;
BlueShadow 6:7946b5c2376a 220 float KX022_Accel[3];
BlueShadow 6:7946b5c2376a 221 #endif
BlueShadow 6:7946b5c2376a 222
BlueShadow 6:7946b5c2376a 223 #ifdef Pressure
BlueShadow 6:7946b5c2376a 224 int Press_addr_w = 0xBA; //write
BlueShadow 6:7946b5c2376a 225 int Press_addr_r = 0xBB; //read
BlueShadow 6:7946b5c2376a 226 char PWR_DOWN[2] = {0x12, 0x01};
BlueShadow 6:7946b5c2376a 227 char SLEEP[2] = {0x13, 0x01};
BlueShadow 6:7946b5c2376a 228 char Mode_Control[2] = {0x14, 0xC4};
BlueShadow 6:7946b5c2376a 229 char Press_Content_ReadData[6];
BlueShadow 6:7946b5c2376a 230 char Press_Addr_ReadData =0x1A;
BlueShadow 6:7946b5c2376a 231 int BM1383_Temp_highByte;
BlueShadow 6:7946b5c2376a 232 int BM1383_Temp_lowByte;
BlueShadow 6:7946b5c2376a 233 int BM1383_Pres_highByte;
BlueShadow 6:7946b5c2376a 234 int BM1383_Pres_lowByte;
BlueShadow 6:7946b5c2376a 235 int BM1383_Pres_leastByte;
BlueShadow 6:7946b5c2376a 236 short int BM1383_Temp_Out;
BlueShadow 6:7946b5c2376a 237 float BM1383_Temp_Conv_Out;
BlueShadow 6:7946b5c2376a 238 float BM1383_Pres_Conv_Out;
BlueShadow 6:7946b5c2376a 239 float_t BM1383[2]; // Temp is 0 and Pressure is 1
BlueShadow 6:7946b5c2376a 240 float BM1383_Var;
BlueShadow 6:7946b5c2376a 241 float BM1383_Deci;
BlueShadow 6:7946b5c2376a 242 #endif
BlueShadow 6:7946b5c2376a 243
BlueShadow 6:7946b5c2376a 244 /****************************************************************************************************
mfiore 0:a44e71488e1f 245 // function prototypes
BlueShadow 6:7946b5c2376a 246 ****************************************************************************************************/
mfiore 0:a44e71488e1f 247 bool init_mtsas();
BlueShadow 6:7946b5c2376a 248 void ReadAnalogTemp();
BlueShadow 6:7946b5c2376a 249 void ReadAnalogUV ();
BlueShadow 6:7946b5c2376a 250 void ReadHallSensor ();
BlueShadow 6:7946b5c2376a 251 void ReadCOLOR ();
BlueShadow 6:7946b5c2376a 252 void ReadRPR0521_ALS ();
BlueShadow 6:7946b5c2376a 253 void ReadKMX62_Accel ();
BlueShadow 6:7946b5c2376a 254 void ReadKMX62_Mag ();
BlueShadow 6:7946b5c2376a 255 void ReadPressure ();
BlueShadow 6:7946b5c2376a 256 void ReadKX022();
BlueShadow 8:e78dcfad254b 257 char* httpResToStr(HTTPResult res);
BlueShadow 8:e78dcfad254b 258
BlueShadow 8:e78dcfad254b 259 namespace patch
BlueShadow 8:e78dcfad254b 260 {
BlueShadow 9:6475e1b83491 261 template < typename T > std::string to_string( const T& n )
BlueShadow 9:6475e1b83491 262 {
BlueShadow 9:6475e1b83491 263 std::ostringstream stm ;
BlueShadow 9:6475e1b83491 264 stm << n ;
BlueShadow 9:6475e1b83491 265 return stm.str() ;
BlueShadow 9:6475e1b83491 266 }
BlueShadow 8:e78dcfad254b 267 }
mfiore 0:a44e71488e1f 268
BlueShadow 6:7946b5c2376a 269 /****************************************************************************************************
mfiore 0:a44e71488e1f 270 // main
BlueShadow 6:7946b5c2376a 271 ****************************************************************************************************/
BlueShadow 6:7946b5c2376a 272 int main()
BlueShadow 6:7946b5c2376a 273 {
mfiore 0:a44e71488e1f 274 mts::MTSLog::setLogLevel(mts::MTSLog::TRACE_LEVEL);
mfiore 0:a44e71488e1f 275 debug.baud(debug_baud);
BlueShadow 6:7946b5c2376a 276
BlueShadow 6:7946b5c2376a 277 // Initialization Radio Section **********************************************************
BlueShadow 8:e78dcfad254b 278 logInfo("initializing cellular radio");
BlueShadow 8:e78dcfad254b 279 if (!init_mtsas()) {
BlueShadow 8:e78dcfad254b 280 while (true) {
BlueShadow 8:e78dcfad254b 281 logError("failed to initialize cellular radio");
BlueShadow 8:e78dcfad254b 282 wait(1);
BlueShadow 8:e78dcfad254b 283 }
BlueShadow 8:e78dcfad254b 284 }
BlueShadow 9:6475e1b83491 285
BlueShadow 8:e78dcfad254b 286 logInfo("Configuring http...\r\n");
BlueShadow 8:e78dcfad254b 287 HTTPClient http;
BlueShadow 8:e78dcfad254b 288 HTTPResult result;
BlueShadow 8:e78dcfad254b 289 http.setHeader(EXOSITE_HEADER);
BlueShadow 9:6475e1b83491 290
BlueShadow 8:e78dcfad254b 291 char http_rx_buf[1024];
BlueShadow 8:e78dcfad254b 292 // IHTTPDataIn object - will contain data received from server.
BlueShadow 8:e78dcfad254b 293 HTTPText http_rx(http_rx_buf, sizeof(http_rx_buf));
BlueShadow 9:6475e1b83491 294
BlueShadow 8:e78dcfad254b 295 // IHTTPDataOut object - contains data to be posted to server.
BlueShadow 8:e78dcfad254b 296 HTTPMap http_tx;
BlueShadow 9:6475e1b83491 297
BlueShadow 9:6475e1b83491 298
BlueShadow 8:e78dcfad254b 299 //****************************************************************************************************
BlueShadow 8:e78dcfad254b 300 // Initialize I2C Devices ************
BlueShadow 8:e78dcfad254b 301 //****************************************************************************************************/
BlueShadow 6:7946b5c2376a 302
BlueShadow 9:6475e1b83491 303 #ifdef RPR0521
BlueShadow 9:6475e1b83491 304 i2c.write(RPR0521_addr_w, &RPR0521_ModeControl[0], 2, false);
BlueShadow 9:6475e1b83491 305 i2c.write(RPR0521_addr_w, &RPR0521_ALSPSControl[0], 2, false);
BlueShadow 9:6475e1b83491 306 i2c.write(RPR0521_addr_w, &RPR0521_Persist[0], 2, false);
BlueShadow 9:6475e1b83491 307 #endif
BlueShadow 9:6475e1b83491 308
BlueShadow 9:6475e1b83491 309 #ifdef KMX62
BlueShadow 9:6475e1b83491 310 i2c.write(KMX62_addr_w, &KMX62_CNTL2[0], 2, false);
BlueShadow 9:6475e1b83491 311 #endif
BlueShadow 9:6475e1b83491 312
BlueShadow 9:6475e1b83491 313 #ifdef COLOR
BlueShadow 9:6475e1b83491 314 i2c.write(BH1745_addr_w, &BH1745_persistence[0], 2, false);
BlueShadow 9:6475e1b83491 315 i2c.write(BH1745_addr_w, &BH1745_mode1[0], 2, false);
BlueShadow 9:6475e1b83491 316 i2c.write(BH1745_addr_w, &BH1745_mode2[0], 2, false);
BlueShadow 9:6475e1b83491 317 i2c.write(BH1745_addr_w, &BH1745_mode3[0], 2, false);
BlueShadow 9:6475e1b83491 318 #endif
BlueShadow 9:6475e1b83491 319
BlueShadow 9:6475e1b83491 320 #ifdef KX022
BlueShadow 9:6475e1b83491 321 i2c.write(KX022_addr_w, &KX022_Accel_CNTL1[0], 2, false);
BlueShadow 9:6475e1b83491 322 i2c.write(KX022_addr_w, &KX022_Accel_ODCNTL[0], 2, false);
BlueShadow 9:6475e1b83491 323 i2c.write(KX022_addr_w, &KX022_Accel_CNTL3[0], 2, false);
BlueShadow 9:6475e1b83491 324 i2c.write(KX022_addr_w, &KX022_Accel_TILT_TIMER[0], 2, false);
BlueShadow 9:6475e1b83491 325 i2c.write(KX022_addr_w, &KX022_Accel_CNTL2[0], 2, false);
BlueShadow 9:6475e1b83491 326 #endif
BlueShadow 9:6475e1b83491 327
BlueShadow 9:6475e1b83491 328 #ifdef Pressure
BlueShadow 9:6475e1b83491 329 i2c.write(Press_addr_w, &PWR_DOWN[0], 2, false);
BlueShadow 9:6475e1b83491 330 i2c.write(Press_addr_w, &SLEEP[0], 2, false);
BlueShadow 9:6475e1b83491 331 i2c.write(Press_addr_w, &Mode_Control[0], 2, false);
BlueShadow 9:6475e1b83491 332 #endif
BlueShadow 9:6475e1b83491 333
BlueShadow 6:7946b5c2376a 334
BlueShadow 8:e78dcfad254b 335 //****************************************************************************************************/
BlueShadow 8:e78dcfad254b 336 //End I2C Initialization Section **********************************************************
BlueShadow 8:e78dcfad254b 337 //****************************************************************************************************/
BlueShadow 9:6475e1b83491 338
BlueShadow 8:e78dcfad254b 339 Timer post_timer;
BlueShadow 9:6475e1b83491 340 post_timer.start();
BlueShadow 8:e78dcfad254b 341 logInfo("Setup complete.");
BlueShadow 8:e78dcfad254b 342 logInfo("Waiting for %d ms to trigger connect...", post_interval_ms);
BlueShadow 6:7946b5c2376a 343
BlueShadow 9:6475e1b83491 344 //*******************************************************************************************************/
BlueShadow 9:6475e1b83491 345 //Beging loop for Main
BlueShadow 9:6475e1b83491 346 //*******************************************************************************************************/
BlueShadow 9:6475e1b83491 347
BlueShadow 8:e78dcfad254b 348 while (true) {
BlueShadow 8:e78dcfad254b 349 if (post_timer.read_ms() > post_interval_ms && do_cloud_post) {
BlueShadow 8:e78dcfad254b 350 logInfo("bringing up the link");
BlueShadow 9:6475e1b83491 351
BlueShadow 9:6475e1b83491 352 #ifdef AnalogTemp
BlueShadow 9:6475e1b83491 353 ReadAnalogTemp ();
BlueShadow 9:6475e1b83491 354 #endif
BlueShadow 9:6475e1b83491 355
BlueShadow 9:6475e1b83491 356 #ifdef AnalogUV
BlueShadow 9:6475e1b83491 357 ReadAnalogUV ();
BlueShadow 9:6475e1b83491 358 #endif
BlueShadow 9:6475e1b83491 359
BlueShadow 9:6475e1b83491 360 #ifdef HallSensor
BlueShadow 9:6475e1b83491 361 ReadHallSensor ();
BlueShadow 9:6475e1b83491 362 #endif
BlueShadow 9:6475e1b83491 363
BlueShadow 9:6475e1b83491 364 #ifdef COLOR
BlueShadow 9:6475e1b83491 365 ReadCOLOR ();
BlueShadow 9:6475e1b83491 366 #endif
BlueShadow 9:6475e1b83491 367
BlueShadow 9:6475e1b83491 368 #ifdef RPR0521 //als digital
BlueShadow 9:6475e1b83491 369 ReadRPR0521_ALS ();
BlueShadow 9:6475e1b83491 370 #endif
BlueShadow 9:6475e1b83491 371
BlueShadow 9:6475e1b83491 372 #ifdef Pressure
BlueShadow 9:6475e1b83491 373 ReadPressure();
BlueShadow 9:6475e1b83491 374 #endif
BlueShadow 9:6475e1b83491 375
BlueShadow 9:6475e1b83491 376 #ifdef KMX62
BlueShadow 9:6475e1b83491 377 ReadKMX62_Accel ();
BlueShadow 9:6475e1b83491 378 ReadKMX62_Mag ();
BlueShadow 9:6475e1b83491 379 #endif
BlueShadow 9:6475e1b83491 380
BlueShadow 9:6475e1b83491 381 #ifdef KX022
BlueShadow 9:6475e1b83491 382 ReadKX022 ();
BlueShadow 9:6475e1b83491 383 #endif
BlueShadow 9:6475e1b83491 384
BlueShadow 9:6475e1b83491 385 logDebug("%s", wall_of_dash);
BlueShadow 9:6475e1b83491 386 logDebug("SENSOR DATA");
BlueShadow 9:6475e1b83491 387 logDebug("temperature: %0.2f C", BM1383[0]);
BlueShadow 9:6475e1b83491 388 logDebug("analog uv: %.1f mW/cm2", ML8511_output);
BlueShadow 9:6475e1b83491 389 logDebug("ambient Light %0.3f", RPR0521_ALS[0]);
BlueShadow 9:6475e1b83491 390 logDebug("proximity count %0.3f", RPR0521_ALS[1]);
BlueShadow 9:6475e1b83491 391 logDebug("hall effect: South %d\t North %d", Hall_Return[0],Hall_Return[1]);
BlueShadow 9:6475e1b83491 392 logDebug("pressure: %0.2f hPa", BM1383[1]);
BlueShadow 9:6475e1b83491 393 logDebug("magnetometer:\r\n\tx: %0.3f\ty: %0.3f\tz: %0.3f\tuT", MEMS_Mag[0], MEMS_Mag[1], MEMS_Mag[2]);
BlueShadow 9:6475e1b83491 394 logDebug("accelerometer:\r\n\tx: %0.3f\ty: %0.3f\tz: %0.3f\tg", MEMS_Accel[0], MEMS_Accel[1], MEMS_Accel[2]);
BlueShadow 9:6475e1b83491 395 logDebug("color:\r\n\tred: %ld\tgrn: %ld\tblu: %ld\t", BH1745[0], BH1745[1], BH1745[2]);
BlueShadow 9:6475e1b83491 396 logDebug("%s", wall_of_dash);
BlueShadow 9:6475e1b83491 397
BlueShadow 9:6475e1b83491 398
BlueShadow 9:6475e1b83491 399 //*******************************************************************************************************/
BlueShadow 9:6475e1b83491 400 //Connect to the radio to send data
BlueShadow 9:6475e1b83491 401 //*******************************************************************************************************/
BlueShadow 9:6475e1b83491 402
BlueShadow 8:e78dcfad254b 403 if (radio->connect()) {
BlueShadow 9:6475e1b83491 404 int sensor_data = RPR0521_ALS[0];
BlueShadow 8:e78dcfad254b 405 logDebug("posting sensor data");
BlueShadow 9:6475e1b83491 406 logDebug("%d",sensor_data);
BlueShadow 10:1c44f9375dd2 407
BlueShadow 10:1c44f9375dd2 408 std::string sensor_data_str = patch::to_string(sensor_data);
BlueShadow 10:1c44f9375dd2 409 logDebug("Sensor data string: %s",sensor_data_str.c_str());
BlueShadow 6:7946b5c2376a 410
BlueShadow 11:d2ac3fa6f2d3 411 http_tx.clear();
BlueShadow 10:1c44f9375dd2 412 http_tx.put("ALS", sensor_data_str.c_str());
BlueShadow 9:6475e1b83491 413
BlueShadow 8:e78dcfad254b 414 // Make HTTP POST request
BlueShadow 8:e78dcfad254b 415 result = http.post(EXOSITE_URL, http_tx, &http_rx);
BlueShadow 8:e78dcfad254b 416 if (result != HTTP_OK) {
BlueShadow 8:e78dcfad254b 417 logError("HTTP POST failed [%d][%s]", result, httpResToStr(result));
BlueShadow 8:e78dcfad254b 418 } else {
BlueShadow 8:e78dcfad254b 419 logInfo("HTTP POST succeeded [%d]\r\n%s", http.getHTTPResponseCode(), http_rx_buf);
BlueShadow 8:e78dcfad254b 420 }
BlueShadow 6:7946b5c2376a 421
mfiore 4:730b61258422 422 radio->disconnect();
mfiore 4:730b61258422 423 } else {
mfiore 4:730b61258422 424 logError("establishing PPP link failed");
mfiore 4:730b61258422 425 }
BlueShadow 6:7946b5c2376a 426
mfiore 4:730b61258422 427 post_timer.reset();
BlueShadow 9:6475e1b83491 428
BlueShadow 8:e78dcfad254b 429 logInfo("Waiting for %d ms to trigger connect...", post_interval_ms);
mfiore 4:730b61258422 430 }
mfiore 0:a44e71488e1f 431 }
mfiore 0:a44e71488e1f 432 }
mfiore 0:a44e71488e1f 433
BlueShadow 8:e78dcfad254b 434
mfiore 1:a049d113e250 435 // init functions
BlueShadow 6:7946b5c2376a 436 bool init_mtsas()
BlueShadow 6:7946b5c2376a 437 {
mfiore 1:a049d113e250 438 io = new MTSSerialFlowControl(RADIO_TX, RADIO_RX, RADIO_RTS, RADIO_CTS);
mfiore 1:a049d113e250 439 if (! io)
mfiore 1:a049d113e250 440 return false;
BlueShadow 6:7946b5c2376a 441
mfiore 1:a049d113e250 442 io->baud(115200);
mfiore 1:a049d113e250 443 radio = CellularFactory::create(io);
mfiore 1:a049d113e250 444 if (! radio)
mfiore 1:a049d113e250 445 return false;
BlueShadow 6:7946b5c2376a 446
mfiore 1:a049d113e250 447 Code ret = radio->setApn(apn);
mfiore 1:a049d113e250 448 if (ret != MTS_SUCCESS)
mfiore 1:a049d113e250 449 return false;
BlueShadow 6:7946b5c2376a 450
mfiore 5:a946ef74a8c4 451 Transport::setTransport(radio);
BlueShadow 6:7946b5c2376a 452
mfiore 1:a049d113e250 453 return true;
mfiore 1:a049d113e250 454 }
mfiore 1:a049d113e250 455
BlueShadow 9:6475e1b83491 456 char* httpResToStr(HTTPResult result)
BlueShadow 9:6475e1b83491 457 {
BlueShadow 8:e78dcfad254b 458 switch(result) {
BlueShadow 8:e78dcfad254b 459 case HTTP_PROCESSING:
BlueShadow 8:e78dcfad254b 460 return "HTTP_PROCESSING";
BlueShadow 8:e78dcfad254b 461 case HTTP_PARSE:
BlueShadow 8:e78dcfad254b 462 return "HTTP_PARSE";
BlueShadow 8:e78dcfad254b 463 case HTTP_DNS:
BlueShadow 8:e78dcfad254b 464 return "HTTP_DNS";
BlueShadow 8:e78dcfad254b 465 case HTTP_PRTCL:
BlueShadow 8:e78dcfad254b 466 return "HTTP_PRTCL";
BlueShadow 8:e78dcfad254b 467 case HTTP_NOTFOUND:
BlueShadow 8:e78dcfad254b 468 return "HTTP_NOTFOUND";
BlueShadow 8:e78dcfad254b 469 case HTTP_REFUSED:
BlueShadow 8:e78dcfad254b 470 return "HTTP_REFUSED";
BlueShadow 8:e78dcfad254b 471 case HTTP_ERROR:
BlueShadow 8:e78dcfad254b 472 return "HTTP_ERROR";
BlueShadow 8:e78dcfad254b 473 case HTTP_TIMEOUT:
BlueShadow 8:e78dcfad254b 474 return "HTTP_TIMEOUT";
BlueShadow 8:e78dcfad254b 475 case HTTP_CONN:
BlueShadow 8:e78dcfad254b 476 return "HTTP_CONN";
BlueShadow 8:e78dcfad254b 477 case HTTP_CLOSED:
BlueShadow 8:e78dcfad254b 478 return "HTTP_CLOSED";
BlueShadow 8:e78dcfad254b 479 case HTTP_REDIRECT:
BlueShadow 8:e78dcfad254b 480 return "HTTP_REDIRECT";
BlueShadow 8:e78dcfad254b 481 case HTTP_OK:
BlueShadow 8:e78dcfad254b 482 return "HTTP_OK";
BlueShadow 8:e78dcfad254b 483 default:
BlueShadow 8:e78dcfad254b 484 return "HTTP Result unknown";
BlueShadow 6:7946b5c2376a 485 }
mfiore 0:a44e71488e1f 486 }
mfiore 0:a44e71488e1f 487
BlueShadow 9:6475e1b83491 488
BlueShadow 9:6475e1b83491 489 //************************************************************************************************/
BlueShadow 9:6475e1b83491 490 // Sensor data acquisition functions
BlueShadow 9:6475e1b83491 491 //************************************************************************************************/
BlueShadow 9:6475e1b83491 492 #ifdef AnalogTemp
BlueShadow 9:6475e1b83491 493 void ReadAnalogTemp ()
BlueShadow 9:6475e1b83491 494 {
BlueShadow 9:6475e1b83491 495 BDE0600_Temp_value = BDE0600_Temp.read_u16();
BlueShadow 9:6475e1b83491 496
BlueShadow 9:6475e1b83491 497 BDE0600_output = (float)BDE0600_Temp_value * (float)0.000050354; //(value * (3.3V/65535))
BlueShadow 9:6475e1b83491 498 BDE0600_output = (BDE0600_output-(float)1.753)/((float)-0.01068) + (float)30;
BlueShadow 9:6475e1b83491 499
BlueShadow 9:6475e1b83491 500 // printf("BDE0600 Analog Temp Sensor Data:\r\n");
BlueShadow 9:6475e1b83491 501 // printf(" Temp = %.2f C\r\n", BDE0600_output);
BlueShadow 9:6475e1b83491 502 }
BlueShadow 9:6475e1b83491 503 #endif
BlueShadow 9:6475e1b83491 504
BlueShadow 9:6475e1b83491 505 #ifdef AnalogUV
BlueShadow 9:6475e1b83491 506 void ReadAnalogUV ()
BlueShadow 9:6475e1b83491 507 {
BlueShadow 9:6475e1b83491 508 ML8511_UV_value = ML8511_UV.read_u16();
BlueShadow 9:6475e1b83491 509 ML8511_output = (float)ML8511_UV_value * (float)0.000050354; //(value * (3.3V/65535)) //Note to self: when playing with this, a negative value is seen... Honestly, I think this has to do with my ADC converstion...
BlueShadow 9:6475e1b83491 510 ML8511_output = (ML8511_output-(float)2.2)/((float)0.129) + 10; // Added +5 to the offset so when inside (aka, no UV, readings show 0)... this is the wrong approach... and the readings don't make sense... Fix this.
BlueShadow 9:6475e1b83491 511
BlueShadow 9:6475e1b83491 512 // printf("ML8511 Analog UV Sensor Data:\r\n");
BlueShadow 9:6475e1b83491 513 // printf(" UV = %.1f mW/cm2\r\n", ML8511_output);
BlueShadow 9:6475e1b83491 514
BlueShadow 9:6475e1b83491 515 }
BlueShadow 9:6475e1b83491 516 #endif
BlueShadow 9:6475e1b83491 517
BlueShadow 9:6475e1b83491 518
BlueShadow 9:6475e1b83491 519 #ifdef HallSensor
BlueShadow 9:6475e1b83491 520 void ReadHallSensor ()
BlueShadow 9:6475e1b83491 521 {
BlueShadow 9:6475e1b83491 522
BlueShadow 9:6475e1b83491 523 Hall_Return[0] = Hall_GPIO0;
BlueShadow 9:6475e1b83491 524 Hall_Return[1] = Hall_GPIO1;
BlueShadow 9:6475e1b83491 525
BlueShadow 9:6475e1b83491 526 // printf("BU52011 Hall Switch Sensor Data:\r\n");
BlueShadow 9:6475e1b83491 527 // printf(" South Detect = %d\r\n", Hall_Return[0]);
BlueShadow 9:6475e1b83491 528 // printf(" North Detect = %d\r\n", Hall_Return[1]);
BlueShadow 9:6475e1b83491 529
BlueShadow 9:6475e1b83491 530
BlueShadow 9:6475e1b83491 531 }
BlueShadow 9:6475e1b83491 532 #endif
BlueShadow 9:6475e1b83491 533
BlueShadow 9:6475e1b83491 534 #ifdef COLOR
BlueShadow 9:6475e1b83491 535 void ReadCOLOR ()
BlueShadow 9:6475e1b83491 536 {
BlueShadow 9:6475e1b83491 537
BlueShadow 9:6475e1b83491 538 //Read color data from the IC
BlueShadow 9:6475e1b83491 539 i2c.write(BH1745_addr_w, &BH1745_Addr_color_ReadData, 1, RepStart);
BlueShadow 9:6475e1b83491 540 i2c.read(BH1745_addr_r, &BH1745_Content_ReadData[0], 6, NoRepStart);
BlueShadow 9:6475e1b83491 541
BlueShadow 9:6475e1b83491 542 //separate all data read into colors
BlueShadow 9:6475e1b83491 543 BH1745[0] = (BH1745_Content_ReadData[1]<<8) | (BH1745_Content_ReadData[0]);
BlueShadow 9:6475e1b83491 544 BH1745[1] = (BH1745_Content_ReadData[3]<<8) | (BH1745_Content_ReadData[2]);
BlueShadow 9:6475e1b83491 545 BH1745[2] = (BH1745_Content_ReadData[5]<<8) | (BH1745_Content_ReadData[4]);
BlueShadow 9:6475e1b83491 546
BlueShadow 9:6475e1b83491 547 //Output Data into UART
BlueShadow 9:6475e1b83491 548 // printf("BH1745 COLOR Sensor Data:\r\n");
BlueShadow 9:6475e1b83491 549 // printf(" Red = %d ADC Counts\r\n",BH1745[0]);
BlueShadow 9:6475e1b83491 550 // printf(" Green = %d ADC Counts\r\n",BH1745[1]);
BlueShadow 9:6475e1b83491 551 // printf(" Blue = %d ADC Counts\r\n",BH1745[2]);
BlueShadow 9:6475e1b83491 552
BlueShadow 9:6475e1b83491 553 }
BlueShadow 9:6475e1b83491 554 #endif
BlueShadow 9:6475e1b83491 555
BlueShadow 9:6475e1b83491 556 #ifdef RPR0521 //als digital
BlueShadow 9:6475e1b83491 557 void ReadRPR0521_ALS ()
BlueShadow 9:6475e1b83491 558 {
BlueShadow 9:6475e1b83491 559 i2c.write(RPR0521_addr_w, &RPR0521_Addr_ReadData, 1, RepStart);
BlueShadow 9:6475e1b83491 560 i2c.read(RPR0521_addr_r, &RPR0521_Content_ReadData[0], 6, NoRepStart);
BlueShadow 9:6475e1b83491 561
BlueShadow 9:6475e1b83491 562 RPR0521_ALS[1] = (RPR0521_Content_ReadData[1]<<8) | (RPR0521_Content_ReadData[0]);
BlueShadow 9:6475e1b83491 563 RPR0521_ALS_D0_RAWOUT = (RPR0521_Content_ReadData[3]<<8) | (RPR0521_Content_ReadData[2]);
BlueShadow 9:6475e1b83491 564 RPR0521_ALS_D1_RAWOUT = (RPR0521_Content_ReadData[5]<<8) | (RPR0521_Content_ReadData[4]);
BlueShadow 9:6475e1b83491 565 RPR0521_ALS_DataRatio = (float)RPR0521_ALS_D1_RAWOUT / (float)RPR0521_ALS_D0_RAWOUT;
BlueShadow 9:6475e1b83491 566
BlueShadow 9:6475e1b83491 567 if(RPR0521_ALS_DataRatio < (float)0.595) {
BlueShadow 9:6475e1b83491 568 RPR0521_ALS[0] = ((float)1.682*(float)RPR0521_ALS_D0_RAWOUT - (float)1.877*(float)RPR0521_ALS_D1_RAWOUT);
BlueShadow 9:6475e1b83491 569 } else if(RPR0521_ALS_DataRatio < (float)1.015) {
BlueShadow 9:6475e1b83491 570 RPR0521_ALS[0] = ((float)0.644*(float)RPR0521_ALS_D0_RAWOUT - (float)0.132*(float)RPR0521_ALS_D1_RAWOUT);
BlueShadow 9:6475e1b83491 571 } else if(RPR0521_ALS_DataRatio < (float)1.352) {
BlueShadow 9:6475e1b83491 572 RPR0521_ALS[0] = ((float)0.756*(float)RPR0521_ALS_D0_RAWOUT - (float)0.243*(float)RPR0521_ALS_D1_RAWOUT);
BlueShadow 9:6475e1b83491 573 } else if(RPR0521_ALS_DataRatio < (float)3.053) {
BlueShadow 9:6475e1b83491 574 RPR0521_ALS[0] = ((float)0.766*(float)RPR0521_ALS_D0_RAWOUT - (float)0.25*(float)RPR0521_ALS_D1_RAWOUT);
BlueShadow 9:6475e1b83491 575 } else {
BlueShadow 9:6475e1b83491 576 RPR0521_ALS[0] = 0;
BlueShadow 9:6475e1b83491 577 }
BlueShadow 9:6475e1b83491 578 // printf("RPR-0521 ALS/PROX Sensor Data:\r\n");
BlueShadow 9:6475e1b83491 579 // printf(" ALS = %0.2f lx\r\n", RPR0521_ALS[0]);
BlueShadow 9:6475e1b83491 580 // printf(" PROX= %0.2f ADC Counts\r\n", RPR0521_ALS[1]); //defined as a float but is an unsigned.
BlueShadow 9:6475e1b83491 581
BlueShadow 9:6475e1b83491 582 }
BlueShadow 9:6475e1b83491 583 #endif
BlueShadow 9:6475e1b83491 584
BlueShadow 9:6475e1b83491 585 #ifdef KMX62
BlueShadow 9:6475e1b83491 586 void ReadKMX62_Accel ()
BlueShadow 9:6475e1b83491 587 {
BlueShadow 9:6475e1b83491 588 //Read Accel Portion from the IC
BlueShadow 9:6475e1b83491 589 i2c.write(KMX62_addr_w, &KMX62_Addr_Accel_ReadData, 1, RepStart);
BlueShadow 9:6475e1b83491 590 i2c.read(KMX62_addr_r, &KMX62_Content_Accel_ReadData[0], 6, NoRepStart);
BlueShadow 9:6475e1b83491 591
BlueShadow 9:6475e1b83491 592 //Note: The highbyte and low byte return a 14bit value, dropping the two LSB in the Low byte.
BlueShadow 9:6475e1b83491 593 // However, because we need the signed value, we will adjust the value when converting to "g"
BlueShadow 9:6475e1b83491 594 MEMS_Accel_Xout = (KMX62_Content_Accel_ReadData[1]<<8) | (KMX62_Content_Accel_ReadData[0]);
BlueShadow 9:6475e1b83491 595 MEMS_Accel_Yout = (KMX62_Content_Accel_ReadData[3]<<8) | (KMX62_Content_Accel_ReadData[2]);
BlueShadow 9:6475e1b83491 596 MEMS_Accel_Zout = (KMX62_Content_Accel_ReadData[5]<<8) | (KMX62_Content_Accel_ReadData[4]);
BlueShadow 9:6475e1b83491 597
BlueShadow 9:6475e1b83491 598 //Note: Conversion to G is as follows:
BlueShadow 9:6475e1b83491 599 // Axis_ValueInG = MEMS_Accel_axis / 1024
BlueShadow 9:6475e1b83491 600 // However, since we did not remove the LSB previously, we need to divide by 4 again
BlueShadow 9:6475e1b83491 601 // Thus, we will divide the output by 4096 (1024*4) to convert and cancel out the LSB
BlueShadow 9:6475e1b83491 602 MEMS_Accel[0] = ((float)MEMS_Accel_Xout/4096/2);
BlueShadow 9:6475e1b83491 603 MEMS_Accel[1] = ((float)MEMS_Accel_Yout/4096/2);
BlueShadow 9:6475e1b83491 604 MEMS_Accel[2] = ((float)MEMS_Accel_Zout/4096/2);
BlueShadow 9:6475e1b83491 605
BlueShadow 9:6475e1b83491 606 // Return Data to UART
BlueShadow 9:6475e1b83491 607 // printf("KMX62 Accel+Mag Sensor Data:\r\n");
BlueShadow 9:6475e1b83491 608 // printf(" AccX= %0.2f g\r\n", MEMS_Accel[0]);
BlueShadow 9:6475e1b83491 609 // printf(" AccY= %0.2f g\r\n", MEMS_Accel[1]);
BlueShadow 9:6475e1b83491 610 // printf(" AccZ= %0.2f g\r\n", MEMS_Accel[2]);
BlueShadow 9:6475e1b83491 611
BlueShadow 9:6475e1b83491 612 }
BlueShadow 9:6475e1b83491 613
BlueShadow 9:6475e1b83491 614 void ReadKMX62_Mag ()
BlueShadow 9:6475e1b83491 615 {
BlueShadow 9:6475e1b83491 616
BlueShadow 9:6475e1b83491 617 //Read Mag portion from the IC
BlueShadow 9:6475e1b83491 618 i2c.write(KMX62_addr_w, &KMX62_Addr_Mag_ReadData, 1, RepStart);
BlueShadow 9:6475e1b83491 619 i2c.read(KMX62_addr_r, &KMX62_Content_Mag_ReadData[0], 6, NoRepStart);
BlueShadow 9:6475e1b83491 620
BlueShadow 9:6475e1b83491 621 //Note: The highbyte and low byte return a 14bit value, dropping the two LSB in the Low byte.
BlueShadow 9:6475e1b83491 622 // However, because we need the signed value, we will adjust the value when converting to "g"
BlueShadow 9:6475e1b83491 623 MEMS_Mag_Xout = (KMX62_Content_Mag_ReadData[1]<<8) | (KMX62_Content_Mag_ReadData[0]);
BlueShadow 9:6475e1b83491 624 MEMS_Mag_Yout = (KMX62_Content_Mag_ReadData[3]<<8) | (KMX62_Content_Mag_ReadData[2]);
BlueShadow 9:6475e1b83491 625 MEMS_Mag_Zout = (KMX62_Content_Mag_ReadData[5]<<8) | (KMX62_Content_Mag_ReadData[4]);
BlueShadow 9:6475e1b83491 626
BlueShadow 9:6475e1b83491 627 //Note: Conversion to G is as follows:
BlueShadow 9:6475e1b83491 628 // Axis_ValueInG = MEMS_Accel_axis / 1024
BlueShadow 9:6475e1b83491 629 // However, since we did not remove the LSB previously, we need to divide by 4 again
BlueShadow 9:6475e1b83491 630 // Thus, we will divide the output by 4095 (1024*4) to convert and cancel out the LSB
BlueShadow 9:6475e1b83491 631 MEMS_Mag[0] = (float)MEMS_Mag_Xout/4096*(float)0.146;
BlueShadow 9:6475e1b83491 632 MEMS_Mag[1] = (float)MEMS_Mag_Yout/4096*(float)0.146;
BlueShadow 9:6475e1b83491 633 MEMS_Mag[2] = (float)MEMS_Mag_Zout/4096*(float)0.146;
BlueShadow 9:6475e1b83491 634
BlueShadow 9:6475e1b83491 635 // Return Data to UART
BlueShadow 9:6475e1b83491 636 // printf(" MagX= %0.2f uT\r\n", MEMS_Mag[0]);
BlueShadow 9:6475e1b83491 637 // printf(" MagY= %0.2f uT\r\n", MEMS_Mag[1]);
BlueShadow 9:6475e1b83491 638 // printf(" MagZ= %0.2f uT\r\n", MEMS_Mag[2]);
BlueShadow 9:6475e1b83491 639
BlueShadow 9:6475e1b83491 640 }
BlueShadow 9:6475e1b83491 641 #endif
BlueShadow 9:6475e1b83491 642
BlueShadow 9:6475e1b83491 643 #ifdef KX022
BlueShadow 9:6475e1b83491 644 void ReadKX022 ()
BlueShadow 9:6475e1b83491 645 {
BlueShadow 9:6475e1b83491 646
BlueShadow 9:6475e1b83491 647 //Read KX022 Portion from the IC
BlueShadow 9:6475e1b83491 648 i2c.write(KX022_addr_w, &KX022_Addr_Accel_ReadData, 1, RepStart);
BlueShadow 9:6475e1b83491 649 i2c.read(KX022_addr_r, &KX022_Content_ReadData[0], 6, NoRepStart);
BlueShadow 9:6475e1b83491 650
BlueShadow 9:6475e1b83491 651 //Format Data
BlueShadow 9:6475e1b83491 652 KX022_Accel_X_RawOUT = (KX022_Content_ReadData[1]<<8) | (KX022_Content_ReadData[0]);
BlueShadow 9:6475e1b83491 653 KX022_Accel_Y_RawOUT = (KX022_Content_ReadData[3]<<8) | (KX022_Content_ReadData[2]);
BlueShadow 9:6475e1b83491 654 KX022_Accel_Z_RawOUT = (KX022_Content_ReadData[5]<<8) | (KX022_Content_ReadData[4]);
BlueShadow 9:6475e1b83491 655
BlueShadow 9:6475e1b83491 656 //Scale Data
BlueShadow 9:6475e1b83491 657 KX022_Accel[0] = (float)KX022_Accel_X_RawOUT / 16384;
BlueShadow 9:6475e1b83491 658 KX022_Accel[1] = (float)KX022_Accel_Y_RawOUT / 16384;
BlueShadow 9:6475e1b83491 659 KX022_Accel[2] = (float)KX022_Accel_Z_RawOUT / 16384;
BlueShadow 9:6475e1b83491 660
BlueShadow 9:6475e1b83491 661 //Return Data through UART
BlueShadow 9:6475e1b83491 662 // printf("KX022 Accelerometer Sensor Data: \r\n");
BlueShadow 9:6475e1b83491 663 // printf(" AccX= %0.2f g\r\n", KX022_Accel[0]);
BlueShadow 9:6475e1b83491 664 // printf(" AccY= %0.2f g\r\n", KX022_Accel[1]);
BlueShadow 9:6475e1b83491 665 // printf(" AccZ= %0.2f g\r\n", KX022_Accel[2]);
BlueShadow 9:6475e1b83491 666
BlueShadow 9:6475e1b83491 667 }
BlueShadow 9:6475e1b83491 668 #endif
BlueShadow 9:6475e1b83491 669
BlueShadow 9:6475e1b83491 670
BlueShadow 9:6475e1b83491 671 #ifdef Pressure
BlueShadow 9:6475e1b83491 672 void ReadPressure ()
BlueShadow 9:6475e1b83491 673 {
BlueShadow 9:6475e1b83491 674
BlueShadow 9:6475e1b83491 675 i2c.write(Press_addr_w, &Press_Addr_ReadData, 1, RepStart);
BlueShadow 9:6475e1b83491 676 i2c.read(Press_addr_r, &Press_Content_ReadData[0], 6, NoRepStart);
BlueShadow 9:6475e1b83491 677
BlueShadow 9:6475e1b83491 678 BM1383_Temp_Out = (Press_Content_ReadData[0]<<8) | (Press_Content_ReadData[1]);
BlueShadow 9:6475e1b83491 679 BM1383[0] = (float)BM1383_Temp_Out/32;
BlueShadow 9:6475e1b83491 680
BlueShadow 9:6475e1b83491 681 BM1383_Var = (Press_Content_ReadData[2]<<3) | (Press_Content_ReadData[3] >> 5);
BlueShadow 9:6475e1b83491 682 BM1383_Deci = ((Press_Content_ReadData[3] & 0x1f) << 6 | ((Press_Content_ReadData[4] >> 2)));
BlueShadow 9:6475e1b83491 683 BM1383_Deci = (float)BM1383_Deci* (float)0.00048828125; //0.00048828125 = 2^-11
BlueShadow 9:6475e1b83491 684 BM1383[1] = (BM1383_Var + BM1383_Deci); //question pending here...
BlueShadow 9:6475e1b83491 685
BlueShadow 9:6475e1b83491 686 // printf("BM1383 Pressure Sensor Data:\r\n");
BlueShadow 9:6475e1b83491 687 // printf(" Temperature= %0.2f C\r\n", BM1383[0]);
BlueShadow 9:6475e1b83491 688 // printf(" Pressure = %0.2f hPa\r\n", BM1383[1]);
BlueShadow 9:6475e1b83491 689
BlueShadow 9:6475e1b83491 690 }
BlueShadow 9:6475e1b83491 691 #endif