Revision 0:7c37eb579038, committed 2019-05-15

Comitter:

jmateo09

Date:

Wed May 15 13:44:30 2019 +0000

Commit message:

Sensors

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Sensors.cpp	Wed May 15 13:44:30 2019 +0000
@@ -0,0 +1,137 @@
+#include "Sensors.h"
+
+Magnetic::Magnetic(): i2c(p28, p27)
+{
+
+}
+
+////////////////////////////////////TLV493//////////////////////////////////////
+void Magnetic::ReadMag(float *output)
+{
+    char Data[7];
+    int i;
+    i2c.read( HallAddress,Data,7);
+
+    i = Data[6] | ((Data[3] & 0xF0) <<4);
+    i = (i >> 11) == 0 ? i : -1 ^ 0xFFF | i;
+    output[3] = (i-320)*1.1;
+
+    i =((Data[4] & 0xF0)>>4) | (Data[0] <<4);
+    i = (i >> 11) == 0 ? i : -1 ^ 0xFFF | i;
+    output[0]=i * 0.098 * 10.0; //0.098mT/LSB 10Gauss/mT;
+    if(abs(output[0])<2) //the sensor has about a 0.2mT | 2Gauss units drift
+        output[0] = 0;     //this is a software filter that suppresses most of the noise
+
+    i =(Data[4] & 0x0F) | (Data[1] <<4);
+    i = (i >> 11) == 0 ? i : -1 ^ 0xFFF | i;
+    output[1]=i * 0.098 * 10.0; //0.098mT/LSB 10Gauss/mT;
+    if(abs(output[1])<2) //the sensor has about a 0.2mT | 2Gauss units drift
+        output[1] = 0;     //this is a software filter that suppresses most of the noise
+
+    i =(Data[5] & 0x0F) | (Data[2] <<4);
+    i = (i >> 11) == 0 ? i : -1 ^ 0xFFF | i;
+    output[2]=i * 0.098 * 10.0; //0.098mT/LSB 10Gauss/mT;
+//  if(abs(output[2])<2) //the sensor has about a 0.2mT | 2Gauss units drift
+//   output[2] = 0;     //this is a software filter that suppresses most of the noise
+}
+
+Accelerometer::Accelerometer(): accelerometer(p28, p27)
+{
+
+}
+
+void Accelerometer::Init()
+{    
+    //Setup up of the Accelerometer(ADXL345),refer to the Mbed libary for any changes.
+    accelerometer.setPowerControl(0x00); //Go into standby mode to configure the device.
+    accelerometer.setDataFormatControl(0x0B); //Full resolution, +/-16g, 4mg/LSB.
+    accelerometer.setDataRate(ADXL345_25HZ); //25Hz data rate.
+    accelerometer.setPowerControl(0x08); //Measurement mode.
+}
+void Accelerometer::ReadAcc(float *output)
+{
+    int readings[3];
+    accelerometer.getOutput(readings);
+    wait_us(1);
+    output[0] = (int16_t) readings[0]; // X-axis
+    output[1] = (int16_t) readings[1]; // Y-Axis
+    output[2] = (int16_t) readings[2]; // Z-Axis
+    output[3] = (atan2 (output[1],output[0]) * 180 / PI) + 180;  // Calculate Angle usoing X and Y
+}
+
+LCD::LCD(): i2c_lcd(p9, p10),lcd(&i2c_lcd,LCDaddress,TextLCD::LCD20x4),ioSetup()
+{
+    
+}
+void LCD::Readlcd()
+{
+    
+}
+
+//////////////////////////////////LCD_RGB////////////////////////////////////////
+void LCD::LCDR()
+{
+    ioSetup.LCDRed = true;
+    ioSetup.LCDGreen = false;
+    ioSetup.LCDBlue = false;
+}
+
+void LCD::LCDG()
+{
+    ioSetup.LCDRed = false;
+    ioSetup.LCDGreen = true;
+    ioSetup.LCDBlue = false;
+}
+
+void LCD::LCDB()
+{
+    ioSetup.LCDRed = false;
+    ioSetup.LCDGreen = false;
+    ioSetup.LCDBlue = true;
+}
+
+void LCD::LCDW()
+{
+    ioSetup.LCDRed = 1.0;
+    ioSetup.LCDGreen = 0.8;
+    ioSetup.LCDBlue = 1.0;
+}
+
+void LCD::LCDOFF()
+{
+    ioSetup.LCDRed = false;
+    ioSetup.LCDGreen = false;
+    ioSetup.LCDBlue = false;
+}
+
+void LCD::RefreshLCD(float *AccData,float *MagData)
+{
+    Battery b;
+    LCDW();
+    time_t Time = time(0);
+    char buffer[32];
+    strftime(buffer, 26, "%d-%m-%Y %H:%M:%S", localtime(&Time));
+
+    lcd.locate(0,0);
+    lcd.printf(buffer);
+    lcd.locate(0,2);
+    lcd.printf("%.0f %.1f  %.0f  %.1f    ",AccData[3],b.GetBatteryVoltage(),MagData[3],MagData[2]);
+    lcd.locate(0,1);
+    lcd.printf("Pos|Vbat|Temp| MagZ ");
+    lcd.locate(0,3);
+    lcd.printf(" Press start button ");
+
+}
+
+Battery::Battery() :Battery_Status(p20)
+{
+}
+/////////////////////////////////Battery Voltage/////////////////////////////////
+float Battery::GetBatteryVoltage()
+{
+
+    float R1 = 10000 , R2 = 2440;
+    float BatteryR = Battery_Status.read()*3.3;
+    float BatteryV = (BatteryR * (R1 + R2)/R2)+0.78;
+    return BatteryV;
+}
\ No newline at end of file

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Sensors.h	Wed May 15 13:44:30 2019 +0000
@@ -0,0 +1,73 @@
+#include "mbed.h"
+#include "XBee.h"
+#include "MODSERIAL.h"
+#include "sstream"
+#include "ADXL345_I2C.h"
+#include "TextLCD.h"
+#include "SDFileSystem.h"
+#include "math.h"
+#include "Setup.h"
+
+#define PI 3.14159265
+
+const int HallAddress =  0xBC; //0x5E <<1;
+const int HallAddressWrite = 0x1;
+const int LCDaddress = 0x40;
+//float AccData[4];
+//float MagData[4];
+//float Temp;
+//float Bat;
+
+class Magnetic
+{
+public:
+    Magnetic();
+    I2C i2c;
+    void ReadMag(float *output);
+
+private:
+
+};
+
+class Accelerometer
+{
+public:
+    Accelerometer();
+    ADXL345_I2C accelerometer;
+    void Init();
+    void ReadAcc(float *output);
+
+private:
+
+};
+
+class Battery;
+class LCD
+{
+public:
+    LCD();
+    I2C i2c_lcd;
+    TextLCD_I2C lcd;
+    IO ioSetup;
+    void Readlcd();
+    //////////////////////////////////LCD_RGB////////////////////////////////////////
+    void LCDR();
+    void LCDG();
+    void LCDB();
+    void LCDW();
+    void LCDOFF();
+    void RefreshLCD(float *AccData,float *Magdata);
+private:
+
+};
+
+class Battery
+{
+public:
+    Battery();
+    //Battery Measuring
+    AnalogIn Battery_Status;
+    /////////////////////////////////Battery Voltage/////////////////////////////////
+    float GetBatteryVoltage();
+private: 
+};