SCIboard(TM): mbed base board data logger - Altimeter: MPL3115A2 - Accelerometer: LSM303DLHC - Gyro: L3G4200D - 4 High Current MOSFET switches

Dependencies:   mbed

/media/uploads/AstrodyneSystems/sciboard_top.jpg

/media/uploads/AstrodyneSystems/sciboard_bottom.jpg

Product Description

SCIboard will take your model rocketry, science, or engineering project to new heights with a complete 10-Degree-Of-Freedom (10-DOF) Inertial Measurement Unit (IMU), 4 high current MOSFET switches, PWM interface (RC servos), USB (memory sticks or BlueTooth) and interfaces for GPS and an XBee® RF module. The SCIboard is an mbed base board ideal for use in college and high school science labs, science fair projects, high power model rocketry, model airplanes, and near space balloon projects. SCIboard is also designed for Open Source software so you can customize the application. Example applications include high power model rocketry, near space balloon projects, and R/C airplanes/quadcopters. While SCIboard requires some basic electronics and software knowledge, it combines multiple breakout boards into a single base board which improves reliability, especially in high g environments such as in model rocketry. Available on Amazon. Search on "SCIboard".

  • Dimensions: 1.5 x 3.8 inches (3.8 x 9.7 cm)
  • Weight: 0.8 ounces (24 g)

10-DOF Inertial Measurement Unit

Going beyond just the 6 degrees of freedom afforded by a 3-axis accelerometer and 3-axis gyro, SCIboard includes an additional 3-axis magnetometer, and highly accurate altimeter / atmospheric pressure sensor. Sensors provide digital measurements over an I2C shared bus (p27 and p28).

Precision Altimeter

(Freescale Semiconductor – MPL3115A2) MEMS pressure sensor with 24-bit Analog-to-Digital Converter (ADC) employs temperature compensation resulting in fully compensated 20-bit pressure/altitude measurements (resolution down to 1 foot).

  • Pressure range: 50 – 110 kPa.
  • Pressure reading noise: 1.5 Pa RMS over -10 to +70° C. Conversion rate: up to 100 Hz.
  • 12-bit temperature sensor measurement range: -40 to +85° C.

3-Axis MEMS Accelerometer

(STMicroelectronics – LSM303DLHC) The sensor measures linear acceleration. Pointing any axis to the earth will apply 1 g in that axis when stationary.

  • Selectable full scale range: +/-2 g to +/-16 g.
  • Sensitivity: 1 – 12 mg/LSB depending on full scale range.
  • Zero-g level offset: +/-60 mg.
  • Acceleration noise density: 220 micro-g/sqrt(Hz).
  • Operating temp range: -40 to +85° C.
  • Conversion rate up to 400 Hz.

3-Axis Ultra-Stable MEMS Gyroscope

(STMicroelectronics – L3G4200D) A gyroscope is an angular rate sensor.

  • Selectable full scale ranges: 250/500/2000 degrees per second (DPS).
  • Resolution: 16-bit.
  • Bandwidth: user selectable.
  • Sensitivity: 8.75/17.50/70 milli-degrees per second/LSB.
  • Nonlinearity: 0.2% full scale
  • Rate noise density: 0.03 DPS/sqrt(Hz).
  • Operating temp range: -40 to +85°C.

Digital I/O

4 MOSFET switches are included. They provide 6-amperes momentary current sinking. Example uses include high power strobes, and lights for night launches or buzzers for location. Switches can be activated at apogee or prior to landing for model rocketry. A continuity check through an analog to digital converter allows verification of circuit continuity before launch. A piezoelectric buzzer provides software control for audible alert and low battery voltage measurement.

/media/uploads/AstrodyneSystems/mosfet.jpg

Host USB Type-A with 5.0 Vdc regulator

USB Type-A connector wired as a host controller provides regulated 5 volt power from a battery. A variety of USB devices from memory sticks, Bluetooth, and Wi-Fi can be used with multiple software projects from the mbed web site.

XBee® and XBee-PRO® Modules

The XBee-PRO® interface supports multiple different XBee and XBee-PRO modules such as Wi-Fi, ZigBee, 802.15.4, Bluetooth, and longer range 900 MHz RF Modules. Compatible modules are Roving Networks and Digi-International. SCIboard provides dual 10 pin headers with regulated 3.3 volt power (from p40) and serial UART (Tx=p9/Rx=p10). Alternatively if the headers are not installed, the serial port may be connected to a SMS cell phone evaluation module. Since the 3.3 volt provided to XBee modules is from the mbed regulator, the user is responsible for power calculations. Testing was done with RN-XV and a 9-volt battery but higher battery voltages or higher current XBee modules could overheat the 3.3 volt regulator on the mbed. When using XBee modules, the user may need to perform hard/soft iron calibration if using the magnetometer.

Interface for GPS

SCIboard provides a serial UART interface for GPS receivers. It also provides 3.3 and 5.0 Vdc for power and Vbat (battery not included). PCB has 0.1” holes for soldered cable or header of your choice. This provides flexibility to use a variety of GPS modules.

/media/uploads/AstrodyneSystems/gps.jpg

Interface for Ethernet Cable

PCB has 0.1” interface for an Ethernet cable of your choice of Ethernet magnetics interface with LEDs. For Ethernet direct wire, use RD-, RD+, TD+, and TD-. For magnetics, several 3.3 Vdc and Grounds are provided allowing easy interfacing. For both LEDs a 160 ohm resistor is provided. Both LEDs share the 2 PWMs out.

/media/uploads/AstrodyneSystems/ethernet.jpg

Interface for PWM RC Servos

SCIboard provides a Pulse Width Modulation (PWM) header for RC servo motors. Up to 6 PWM servos can be controlled. Terminal block is provided for separate servo power source if desired. If the user chooses to not install the headers, the PCB has 0.1” spacing thru-holes for 3-pin R/C servos. (Pins 21 – 26)

/media/uploads/AstrodyneSystems/pwm.jpg

Applications

A 10-Degree-Of-Freedom Inertial Measurement Unit (IMU) can be used to measure distance traveled, velocity, acceleration, attitude (yaw, pitch, and roll), and attitude rate. When combined with a GPS, SCIboard will provide a GPS aided inertial navigation solutions. The PWM can be used to control a camera attached to a servo motor. This enables near space projects to point the camera up at the weather balloon, horizontally at the earth’s horizon, and down directly at the earth.

  1. College and high school science labs
  2. Science Fairs
  3. High Power Model Rocketry
  4. Near Space Balloons
  5. Quadcopters
  6. R/C Airplanes
  7. R/C Helicopter

Processor Board Support (Direct Pin-Out compatible)

  • mbed LPC1768
  • mbed LPC11U24
  • Embedded Artists LPCexpresso LPC1769
Committer:
AstrodyneSystems
Date:
Wed Dec 18 16:21:57 2013 +0000
Revision:
3:a0863e392562
Parent:
2:6698a2433bfd
Child:
4:09ffcb9bc1d3
Added L3G4200DTR

Who changed what in which revision?

UserRevisionLine numberNew contents of line
AstrodyneSystems 0:ab51d784ef36 1 /* SCIboard(TM) main.cpp
AstrodyneSystems 0:ab51d784ef36 2 Copyright (c) 2013 K. Andres
AstrodyneSystems 0:ab51d784ef36 3
AstrodyneSystems 0:ab51d784ef36 4 Permission is hereby granted, free of charge, to any person obtaining a copy
AstrodyneSystems 0:ab51d784ef36 5 of this software and associated documentation files (the "Software"), to deal
AstrodyneSystems 0:ab51d784ef36 6 in the Software without restriction, including without limitation the rights
AstrodyneSystems 0:ab51d784ef36 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
AstrodyneSystems 0:ab51d784ef36 8 copies of the Software, and to permit persons to whom the Software is
AstrodyneSystems 0:ab51d784ef36 9 furnished to do so, subject to the following conditions:
AstrodyneSystems 0:ab51d784ef36 10
AstrodyneSystems 0:ab51d784ef36 11 The above copyright notice and this permission notice shall be included in
AstrodyneSystems 0:ab51d784ef36 12 all copies or substantial portions of the Software.
AstrodyneSystems 0:ab51d784ef36 13
AstrodyneSystems 0:ab51d784ef36 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
AstrodyneSystems 0:ab51d784ef36 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
AstrodyneSystems 0:ab51d784ef36 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
AstrodyneSystems 0:ab51d784ef36 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
AstrodyneSystems 0:ab51d784ef36 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
AstrodyneSystems 0:ab51d784ef36 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
AstrodyneSystems 0:ab51d784ef36 20 THE SOFTWARE.
AstrodyneSystems 0:ab51d784ef36 21 */
AstrodyneSystems 0:ab51d784ef36 22
AstrodyneSystems 0:ab51d784ef36 23 /* OVERVIEW
AstrodyneSystems 1:a54c4a4f3b30 24 Displays on USB serial (9600 bps)
AstrodyneSystems 1:a54c4a4f3b30 25 MPL3115A2 ident 0xC4
AstrodyneSystems 1:a54c4a4f3b30 26 LSM303 ident 0x48 0x34 0x33
AstrodyneSystems 3:a0863e392562 27 L3G4200DTR ident 0xD3
AstrodyneSystems 0:ab51d784ef36 28 then collects 10 seconds of data from accelerometer and magnetometer
AstrodyneSystems 0:ab51d784ef36 29
AstrodyneSystems 0:ab51d784ef36 30 Filename on Local: OUTxx.csv (csv format allows easy import into spreadsheets)
AstrodyneSystems 0:ab51d784ef36 31 Format: microseconds,record type, variable length data\r\n
AstrodyneSystems 1:a54c4a4f3b30 32 Rec type 1= altimeter data altitude (meters) and semiconductor temperature (deg C)
AstrodyneSystems 0:ab51d784ef36 33 Rec type 2= accelerometer data x, y, and z in g's
AstrodyneSystems 3:a0863e392562 34 Rec type 3= magnetometer data x, y, and z
AstrodyneSystems 3:a0863e392562 35 Rec type 4= gyro data x, y, z in degrees per second (dps)
AstrodyneSystems 0:ab51d784ef36 36
AstrodyneSystems 3:a0863e392562 37 MOSFET switch software coming soon (under development)...
AstrodyneSystems 0:ab51d784ef36 38 */
AstrodyneSystems 0:ab51d784ef36 39
AstrodyneSystems 0:ab51d784ef36 40 #include "mbed.h"
AstrodyneSystems 0:ab51d784ef36 41 #include "math.h"
AstrodyneSystems 0:ab51d784ef36 42
AstrodyneSystems 0:ab51d784ef36 43 #include "SCIboard_I2C.h"
AstrodyneSystems 1:a54c4a4f3b30 44 #include "SCIboard_MPL3115A2.h"
AstrodyneSystems 0:ab51d784ef36 45 #include "SCIboard_LSM303DLHC.h"
AstrodyneSystems 3:a0863e392562 46 #include "SCIboard_L3G4200DTR.h"
AstrodyneSystems 0:ab51d784ef36 47 #include "SCIboard_DataLogger.h"
AstrodyneSystems 2:6698a2433bfd 48 #include "SCIboard_ConfigFile.h"
AstrodyneSystems 0:ab51d784ef36 49
AstrodyneSystems 0:ab51d784ef36 50 // LEDs
AstrodyneSystems 0:ab51d784ef36 51 DigitalOut led1(LED1);
AstrodyneSystems 0:ab51d784ef36 52 DigitalOut led2(LED2);
AstrodyneSystems 0:ab51d784ef36 53 DigitalOut led3(LED3);
AstrodyneSystems 0:ab51d784ef36 54 DigitalOut led4(LED4);
AstrodyneSystems 0:ab51d784ef36 55
AstrodyneSystems 0:ab51d784ef36 56 // PWM out
AstrodyneSystems 0:ab51d784ef36 57 PwmOut pwm1(p26);
AstrodyneSystems 0:ab51d784ef36 58 PwmOut pwm2(p25);
AstrodyneSystems 0:ab51d784ef36 59 PwmOut pwm3(p24);
AstrodyneSystems 0:ab51d784ef36 60 PwmOut pwm4(p23);
AstrodyneSystems 0:ab51d784ef36 61 PwmOut pwm5(p22);
AstrodyneSystems 0:ab51d784ef36 62 PwmOut pwm6(p21);
AstrodyneSystems 0:ab51d784ef36 63
AstrodyneSystems 0:ab51d784ef36 64 // Serial gps(p13, p14);
AstrodyneSystems 0:ab51d784ef36 65 // Serial Xbee(p9, p10);
AstrodyneSystems 0:ab51d784ef36 66
AstrodyneSystems 0:ab51d784ef36 67 // Buzzer
AstrodyneSystems 0:ab51d784ef36 68 DigitalOut alert(p29); // CAN_RD
AstrodyneSystems 0:ab51d784ef36 69
AstrodyneSystems 0:ab51d784ef36 70 // MOSFET controls
AstrodyneSystems 0:ab51d784ef36 71 DigitalOut fet_out1(p15); // ADC1
AstrodyneSystems 0:ab51d784ef36 72 DigitalOut fet_out2(p12); // SPI2_MISO
AstrodyneSystems 0:ab51d784ef36 73 DigitalOut fet_out3(p11); // SPI2_MOSI
AstrodyneSystems 0:ab51d784ef36 74 DigitalOut fet_out4(p8); // GPIO8
AstrodyneSystems 0:ab51d784ef36 75
AstrodyneSystems 0:ab51d784ef36 76 // ADC inputs
AstrodyneSystems 0:ab51d784ef36 77 AnalogIn batt_mon(p16); // ADC2
AstrodyneSystems 0:ab51d784ef36 78 AnalogIn fet_mon1(p17); // ADC3
AstrodyneSystems 0:ab51d784ef36 79 AnalogIn fet_mon2(p18); // ADC4
AstrodyneSystems 0:ab51d784ef36 80 AnalogIn fet_mon3(p19); // ADC5
AstrodyneSystems 0:ab51d784ef36 81 AnalogIn fet_mon4(p20); // ADC6
AstrodyneSystems 0:ab51d784ef36 82
AstrodyneSystems 0:ab51d784ef36 83 //
AstrodyneSystems 0:ab51d784ef36 84 Serial pc(USBTX, USBRX); // Default 9600 bps
AstrodyneSystems 0:ab51d784ef36 85
AstrodyneSystems 0:ab51d784ef36 86 // Timers
AstrodyneSystems 0:ab51d784ef36 87 Timer t;
AstrodyneSystems 0:ab51d784ef36 88 int time_ms;
AstrodyneSystems 0:ab51d784ef36 89
AstrodyneSystems 0:ab51d784ef36 90
AstrodyneSystems 0:ab51d784ef36 91 // I2C interface
AstrodyneSystems 0:ab51d784ef36 92 //#define sdaPin p9
AstrodyneSystems 0:ab51d784ef36 93 //#define sdcPin p10
AstrodyneSystems 0:ab51d784ef36 94 #define sdaPin p28
AstrodyneSystems 0:ab51d784ef36 95 #define sdcPin p27
AstrodyneSystems 0:ab51d784ef36 96
AstrodyneSystems 0:ab51d784ef36 97 SCIboard_I2C i2cBus(sdaPin, sdcPin);
AstrodyneSystems 0:ab51d784ef36 98
AstrodyneSystems 1:a54c4a4f3b30 99 // Altimeter
AstrodyneSystems 1:a54c4a4f3b30 100 SCIboard_MPL3115A2 alt(&i2cBus);
AstrodyneSystems 1:a54c4a4f3b30 101 InterruptIn MPL3115A2_INT1(p5);
AstrodyneSystems 1:a54c4a4f3b30 102 void MPL3115A2_INT1_INTERRUPT(void);
AstrodyneSystems 1:a54c4a4f3b30 103 //InterruptIn MPL3115A2_INT2();
AstrodyneSystems 1:a54c4a4f3b30 104
AstrodyneSystems 1:a54c4a4f3b30 105 const int accAltDecimate=5;
AstrodyneSystems 1:a54c4a4f3b30 106 int accCnt=0;
AstrodyneSystems 0:ab51d784ef36 107
AstrodyneSystems 3:a0863e392562 108
AstrodyneSystems 0:ab51d784ef36 109 // Accelerometer and magnetometer
AstrodyneSystems 0:ab51d784ef36 110 SCIboard_LSM303DLHC lsm303(&i2cBus);
AstrodyneSystems 0:ab51d784ef36 111 InterruptIn LSM303DLHC_DRDY(p7);
AstrodyneSystems 0:ab51d784ef36 112 void LSM303DLHC_DRDY_INTERRUPT(void);
AstrodyneSystems 0:ab51d784ef36 113 //InterruptIn LSM303DLHC_INT1(p6);
AstrodyneSystems 0:ab51d784ef36 114 //void LSM303DLHC_INT1_INTERRUPT(void);
AstrodyneSystems 0:ab51d784ef36 115 // INT2 n/c
AstrodyneSystems 0:ab51d784ef36 116
AstrodyneSystems 0:ab51d784ef36 117
AstrodyneSystems 3:a0863e392562 118 // Gyro
AstrodyneSystems 3:a0863e392562 119 SCIboard_L3G4200DTR l3g4200dtr(&i2cBus, GYR_DR_100HZ, GYR_BW_0, GYR_FS_250DPS);
AstrodyneSystems 3:a0863e392562 120 //InterruptIn L3G4200DTR_INT();
AstrodyneSystems 3:a0863e392562 121 //InterruptIn L3G4200DTR_DRDY(p24);
AstrodyneSystems 3:a0863e392562 122 //void L3G4200DTR_INTERRUPT(void);
AstrodyneSystems 3:a0863e392562 123
AstrodyneSystems 3:a0863e392562 124
AstrodyneSystems 2:6698a2433bfd 125 // Configuration data
AstrodyneSystems 2:6698a2433bfd 126 void ReadConfigfile(void);
AstrodyneSystems 2:6698a2433bfd 127 float fMachDelay, fApogeeDelay, fMainDeploymentAlt, fLowVoltageAlarm, fAltLog, fAccelLog, fMagLog, fGyroLog;
AstrodyneSystems 2:6698a2433bfd 128
AstrodyneSystems 2:6698a2433bfd 129 char *cfgKeyStr[]={
AstrodyneSystems 2:6698a2433bfd 130 "MACH DELAY (s)",
AstrodyneSystems 2:6698a2433bfd 131 "APOGEE DELAY (s)",
AstrodyneSystems 2:6698a2433bfd 132 "MAIN DEPLOYMENT (ft)",
AstrodyneSystems 2:6698a2433bfd 133 "LOW VOLTAGE ALARM (v)",
AstrodyneSystems 2:6698a2433bfd 134 "ALT LOG (1|0)",
AstrodyneSystems 2:6698a2433bfd 135 "ACCEL LOG (1|0)",
AstrodyneSystems 2:6698a2433bfd 136 "MAG LOG (1|0)",
AstrodyneSystems 2:6698a2433bfd 137 "GYRO LOG (1|0)"
AstrodyneSystems 2:6698a2433bfd 138 // NMEA Log(1|0)",
AstrodyneSystems 2:6698a2433bfd 139 //"SSID",
AstrodyneSystems 2:6698a2433bfd 140 //"PASSWD",
AstrodyneSystems 2:6698a2433bfd 141 };
AstrodyneSystems 2:6698a2433bfd 142
AstrodyneSystems 2:6698a2433bfd 143 float *cfgFloatPtr[] = {
AstrodyneSystems 2:6698a2433bfd 144 &fMachDelay, &fApogeeDelay, &fMainDeploymentAlt, &fLowVoltageAlarm, &fAltLog, &fAccelLog, &fMagLog, &fGyroLog};
AstrodyneSystems 2:6698a2433bfd 145
AstrodyneSystems 0:ab51d784ef36 146 //---------------------------------------------------------------------
AstrodyneSystems 0:ab51d784ef36 147 int main() {
AstrodyneSystems 0:ab51d784ef36 148 unsigned char data[10];
AstrodyneSystems 0:ab51d784ef36 149 float f[3];
AstrodyneSystems 0:ab51d784ef36 150 char str[132];
AstrodyneSystems 0:ab51d784ef36 151 int currentTime;
AstrodyneSystems 0:ab51d784ef36 152 int lastTime=0;
AstrodyneSystems 3:a0863e392562 153 float gyro_store[3];
AstrodyneSystems 3:a0863e392562 154 bool bGyroDataStored=false;
AstrodyneSystems 0:ab51d784ef36 155
AstrodyneSystems 3:a0863e392562 156 // Ensure interrupts are off
AstrodyneSystems 1:a54c4a4f3b30 157 MPL3115A2_INT1.fall(NULL);
AstrodyneSystems 0:ab51d784ef36 158 LSM303DLHC_DRDY.fall(NULL);
AstrodyneSystems 0:ab51d784ef36 159 // LSM303DLHC_INT1.rise(NULL);
AstrodyneSystems 3:a0863e392562 160 // L3G4200DTR_DRDY.fall(NULL);
AstrodyneSystems 3:a0863e392562 161
AstrodyneSystems 2:6698a2433bfd 162 ReadConfigfile();
AstrodyneSystems 2:6698a2433bfd 163
AstrodyneSystems 0:ab51d784ef36 164 // DataLogger
AstrodyneSystems 0:ab51d784ef36 165 nextFilename();
AstrodyneSystems 0:ab51d784ef36 166
AstrodyneSystems 1:a54c4a4f3b30 167 // Get I2C device IDs
AstrodyneSystems 1:a54c4a4f3b30 168 sprintf(str, "MPL3115A2 Ident 0x%X\r\n", alt.getDeviceID());
AstrodyneSystems 1:a54c4a4f3b30 169 pc.printf(str);
AstrodyneSystems 1:a54c4a4f3b30 170 log_write(str);
AstrodyneSystems 1:a54c4a4f3b30 171
AstrodyneSystems 0:ab51d784ef36 172 lsm303.getDeviceID(data);
AstrodyneSystems 0:ab51d784ef36 173 sprintf(str, "LSM303DLHC Ident 0x%X 0x%X 0x%X\r\n", data[0], data[1], data[2]);
AstrodyneSystems 0:ab51d784ef36 174 pc.printf(str);
AstrodyneSystems 0:ab51d784ef36 175 log_write(str);
AstrodyneSystems 0:ab51d784ef36 176
AstrodyneSystems 3:a0863e392562 177 sprintf(str, "L3G4200DTR Ident 0x%X\r\n", l3g4200dtr.getDeviceID());
AstrodyneSystems 3:a0863e392562 178 pc.printf(str);
AstrodyneSystems 3:a0863e392562 179 log_write(str);
AstrodyneSystems 0:ab51d784ef36 180
AstrodyneSystems 0:ab51d784ef36 181 // Setup accelerometer and magnetometer
AstrodyneSystems 0:ab51d784ef36 182 lsm303.setAccMode(ACC_4G, ACC_50HZ);
AstrodyneSystems 0:ab51d784ef36 183 lsm303.setMagMode(MAG_1p3G, MAG_75HZ);
AstrodyneSystems 0:ab51d784ef36 184
AstrodyneSystems 1:a54c4a4f3b30 185 // Setup altimeter
AstrodyneSystems 1:a54c4a4f3b30 186 alt.setMode(ALT_MODE, OS4);
AstrodyneSystems 1:a54c4a4f3b30 187 alt.OST(); // initiate first conversion
AstrodyneSystems 1:a54c4a4f3b30 188 MPL3115A2_INT1.fall(MPL3115A2_INT1_INTERRUPT);
AstrodyneSystems 1:a54c4a4f3b30 189
AstrodyneSystems 0:ab51d784ef36 190 t.start(); // start timer
AstrodyneSystems 0:ab51d784ef36 191
AstrodyneSystems 0:ab51d784ef36 192 LSM303DLHC_DRDY.fall(LSM303DLHC_DRDY_INTERRUPT); // Magnetometer
AstrodyneSystems 0:ab51d784ef36 193 // LSM303DLHC_INT1.rise(LSM303DLHC_INT1_INTERRUPT); // Accelerometer
AstrodyneSystems 0:ab51d784ef36 194
AstrodyneSystems 0:ab51d784ef36 195
AstrodyneSystems 0:ab51d784ef36 196 // Collect 10 seconds of data then close file system to allow mbed to be visible on USB connected PC for demo app only
AstrodyneSystems 0:ab51d784ef36 197 while(t.read()<10) {
AstrodyneSystems 0:ab51d784ef36 198 time_ms = t.read_ms();
AstrodyneSystems 0:ab51d784ef36 199 currentTime = t.read();
AstrodyneSystems 0:ab51d784ef36 200 if(currentTime!=lastTime) {
AstrodyneSystems 0:ab51d784ef36 201 lastTime = currentTime;
AstrodyneSystems 0:ab51d784ef36 202 led2 = !led2; // slow blink led
AstrodyneSystems 0:ab51d784ef36 203 }
AstrodyneSystems 0:ab51d784ef36 204
AstrodyneSystems 0:ab51d784ef36 205 __disable_irq();
AstrodyneSystems 0:ab51d784ef36 206
AstrodyneSystems 0:ab51d784ef36 207 // Accelerometer
AstrodyneSystems 0:ab51d784ef36 208 if(lsm303.bAccDataAvailable()) {
AstrodyneSystems 0:ab51d784ef36 209 lsm303.getAccData(f);
AstrodyneSystems 0:ab51d784ef36 210 sprintf(str,"%u,2,%.3f,%.3f,%.3f\r\n", time_ms, f[0], f[1], f[2]);
AstrodyneSystems 0:ab51d784ef36 211 log_write(str);
AstrodyneSystems 1:a54c4a4f3b30 212 if(++accCnt >= accAltDecimate) {
AstrodyneSystems 1:a54c4a4f3b30 213 accCnt = 0;
AstrodyneSystems 1:a54c4a4f3b30 214 alt.OST();
AstrodyneSystems 1:a54c4a4f3b30 215 }
AstrodyneSystems 0:ab51d784ef36 216 }
AstrodyneSystems 0:ab51d784ef36 217
AstrodyneSystems 0:ab51d784ef36 218
AstrodyneSystems 0:ab51d784ef36 219 #ifdef NON_DRDY_MAG
AstrodyneSystems 0:ab51d784ef36 220 // Magnetometer
AstrodyneSystems 0:ab51d784ef36 221 data[0] = lsm303.getMagStatus();
AstrodyneSystems 0:ab51d784ef36 222 pc.printf("MagStatus=%X\r\n", data[0]);
AstrodyneSystems 0:ab51d784ef36 223
AstrodyneSystems 0:ab51d784ef36 224 if(lsm303.bMagDataAvailable()) {
AstrodyneSystems 0:ab51d784ef36 225 lsm303.getMagData(f);
AstrodyneSystems 0:ab51d784ef36 226 pc.printf("MAG: %.3f %.3f %.3f %.0f\r\n", f[0], f[1], f[2], atan2(f[1],f[0])*180.0/PI);
AstrodyneSystems 0:ab51d784ef36 227 }
AstrodyneSystems 0:ab51d784ef36 228 #endif
AstrodyneSystems 3:a0863e392562 229
AstrodyneSystems 3:a0863e392562 230 // Gyro
AstrodyneSystems 3:a0863e392562 231 if(l3g4200dtr.getStatus() & STATUS_REG_ZYXDA)
AstrodyneSystems 3:a0863e392562 232 {
AstrodyneSystems 3:a0863e392562 233 if(bGyroDataStored) {
AstrodyneSystems 3:a0863e392562 234 l3g4200dtr.getData(f);
AstrodyneSystems 3:a0863e392562 235 sprintf(str, "%u,4,%.3f,%.3f,%.3f\r\n", time_ms, f[0]+gyro_store[0], f[1]+gyro_store[1], f[2]+gyro_store[2]);
AstrodyneSystems 3:a0863e392562 236 log_write(str);
AstrodyneSystems 3:a0863e392562 237 bGyroDataStored = false;
AstrodyneSystems 3:a0863e392562 238 }
AstrodyneSystems 3:a0863e392562 239 else {
AstrodyneSystems 3:a0863e392562 240 l3g4200dtr.getData(gyro_store);
AstrodyneSystems 3:a0863e392562 241 bGyroDataStored = true;
AstrodyneSystems 3:a0863e392562 242 }
AstrodyneSystems 3:a0863e392562 243 }
AstrodyneSystems 3:a0863e392562 244
AstrodyneSystems 0:ab51d784ef36 245 __enable_irq();
AstrodyneSystems 0:ab51d784ef36 246
AstrodyneSystems 0:ab51d784ef36 247 }
AstrodyneSystems 3:a0863e392562 248
AstrodyneSystems 3:a0863e392562 249 // Ensure interrupts are off
AstrodyneSystems 1:a54c4a4f3b30 250 MPL3115A2_INT1.fall(NULL);
AstrodyneSystems 0:ab51d784ef36 251 LSM303DLHC_DRDY.fall(NULL);
AstrodyneSystems 0:ab51d784ef36 252 // LSM303DLHC_INT1.rise(NULL);
AstrodyneSystems 3:a0863e392562 253 // L3G4200DTR_DRDY.fall(NULL);
AstrodyneSystems 3:a0863e392562 254
AstrodyneSystems 0:ab51d784ef36 255 wait(.1);
AstrodyneSystems 0:ab51d784ef36 256 log_close();
AstrodyneSystems 0:ab51d784ef36 257 pc.printf("Done.\r\n");
AstrodyneSystems 0:ab51d784ef36 258 led2=0;
AstrodyneSystems 0:ab51d784ef36 259
AstrodyneSystems 0:ab51d784ef36 260 // Signal program done
AstrodyneSystems 0:ab51d784ef36 261 while(1) {
AstrodyneSystems 0:ab51d784ef36 262 led1 = 1;
AstrodyneSystems 0:ab51d784ef36 263 wait(0.2);
AstrodyneSystems 0:ab51d784ef36 264 led1 = 0;
AstrodyneSystems 0:ab51d784ef36 265 wait(0.2);
AstrodyneSystems 0:ab51d784ef36 266 }
AstrodyneSystems 0:ab51d784ef36 267 }
AstrodyneSystems 0:ab51d784ef36 268
AstrodyneSystems 0:ab51d784ef36 269
AstrodyneSystems 1:a54c4a4f3b30 270 // Altimeter interrupt service ----------------------------------------
AstrodyneSystems 1:a54c4a4f3b30 271 void MPL3115A2_INT1_INTERRUPT(void)
AstrodyneSystems 1:a54c4a4f3b30 272 {
AstrodyneSystems 1:a54c4a4f3b30 273 float f[3];
AstrodyneSystems 1:a54c4a4f3b30 274 char str[80];
AstrodyneSystems 1:a54c4a4f3b30 275
AstrodyneSystems 1:a54c4a4f3b30 276 __disable_irq();
AstrodyneSystems 1:a54c4a4f3b30 277
AstrodyneSystems 1:a54c4a4f3b30 278 alt.getData(f);
AstrodyneSystems 1:a54c4a4f3b30 279 sprintf(str, "%u,1,%.1f,%.1f\r\n", time_ms, f[0], f[1]);
AstrodyneSystems 1:a54c4a4f3b30 280 log_write(str);
AstrodyneSystems 1:a54c4a4f3b30 281
AstrodyneSystems 1:a54c4a4f3b30 282 __enable_irq();
AstrodyneSystems 1:a54c4a4f3b30 283 }
AstrodyneSystems 1:a54c4a4f3b30 284
AstrodyneSystems 0:ab51d784ef36 285
AstrodyneSystems 0:ab51d784ef36 286 // Magnetometer interrupt service -------------------------------------
AstrodyneSystems 0:ab51d784ef36 287 void LSM303DLHC_DRDY_INTERRUPT(void)
AstrodyneSystems 0:ab51d784ef36 288 {
AstrodyneSystems 0:ab51d784ef36 289 float f[3];
AstrodyneSystems 0:ab51d784ef36 290 char str[80];
AstrodyneSystems 0:ab51d784ef36 291
AstrodyneSystems 0:ab51d784ef36 292 __disable_irq();
AstrodyneSystems 0:ab51d784ef36 293 lsm303.getMagData(f);
AstrodyneSystems 0:ab51d784ef36 294 sprintf(str, "%u,3,%.3f,%.3f,%.3f\r\n", time_ms, f[0], f[1], f[2]);
AstrodyneSystems 0:ab51d784ef36 295 log_write(str);
AstrodyneSystems 0:ab51d784ef36 296 __enable_irq();
AstrodyneSystems 0:ab51d784ef36 297 }
AstrodyneSystems 0:ab51d784ef36 298
AstrodyneSystems 0:ab51d784ef36 299
AstrodyneSystems 0:ab51d784ef36 300 // Accelerometer interrupt service ------------------------------------
AstrodyneSystems 0:ab51d784ef36 301 /*void LSM303DLHC_INT1_INTERRUPT(void)
AstrodyneSystems 0:ab51d784ef36 302 {
AstrodyneSystems 0:ab51d784ef36 303 float f[3];
AstrodyneSystems 0:ab51d784ef36 304 unsigned char src;
AstrodyneSystems 0:ab51d784ef36 305 char str[80];
AstrodyneSystems 0:ab51d784ef36 306
AstrodyneSystems 0:ab51d784ef36 307 __disable_irq();
AstrodyneSystems 0:ab51d784ef36 308
AstrodyneSystems 0:ab51d784ef36 309 src = lsm303.getInt1Src();
AstrodyneSystems 0:ab51d784ef36 310 if(lsm303.bAccDataAvailable()) {
AstrodyneSystems 0:ab51d784ef36 311 lsm303.getAccData(f);
AstrodyneSystems 0:ab51d784ef36 312 sprintf(str,"%u,2,%.3f,%.3f,%.3f,%x\r\n", time_ms, f[0], f[1], f[2], src);
AstrodyneSystems 0:ab51d784ef36 313 log_write(str);
AstrodyneSystems 0:ab51d784ef36 314 if(++accCnt >= accAltDecimate) {
AstrodyneSystems 0:ab51d784ef36 315 accCnt = 0;
AstrodyneSystems 0:ab51d784ef36 316 alt.OST();
AstrodyneSystems 0:ab51d784ef36 317 }
AstrodyneSystems 0:ab51d784ef36 318 }
AstrodyneSystems 0:ab51d784ef36 319
AstrodyneSystems 0:ab51d784ef36 320 __enable_irq();
AstrodyneSystems 0:ab51d784ef36 321 }
AstrodyneSystems 0:ab51d784ef36 322 */
AstrodyneSystems 2:6698a2433bfd 323
AstrodyneSystems 2:6698a2433bfd 324
AstrodyneSystems 2:6698a2433bfd 325 // Read configuration file --------------------------------------------
AstrodyneSystems 2:6698a2433bfd 326 void ReadConfigfile(void) {
AstrodyneSystems 2:6698a2433bfd 327 ConfigFile cfgFile("/local/SCIbdCfg.txt");
AstrodyneSystems 2:6698a2433bfd 328 int n;
AstrodyneSystems 2:6698a2433bfd 329 float f;
AstrodyneSystems 2:6698a2433bfd 330
AstrodyneSystems 2:6698a2433bfd 331 for(n=0; n<sizeof(cfgKeyStr)/sizeof(char*); n++) {
AstrodyneSystems 2:6698a2433bfd 332 if(cfgFile.getValue(cfgKeyStr[n], &f))
AstrodyneSystems 2:6698a2433bfd 333 {
AstrodyneSystems 2:6698a2433bfd 334 if(f < 0) f = 0;
AstrodyneSystems 2:6698a2433bfd 335 *(cfgFloatPtr[n]) = f;
AstrodyneSystems 2:6698a2433bfd 336 pc.printf("Found: %s: %f\r\n", cfgKeyStr[n], f);
AstrodyneSystems 2:6698a2433bfd 337 }
AstrodyneSystems 2:6698a2433bfd 338 }
AstrodyneSystems 2:6698a2433bfd 339 cfgFile.closeFile();
AstrodyneSystems 2:6698a2433bfd 340
AstrodyneSystems 2:6698a2433bfd 341 if(fMachDelay > 15.0)
AstrodyneSystems 2:6698a2433bfd 342 fMachDelay = 15;
AstrodyneSystems 2:6698a2433bfd 343
AstrodyneSystems 2:6698a2433bfd 344 if(fApogeeDelay > 1)
AstrodyneSystems 2:6698a2433bfd 345 fApogeeDelay = 1;
AstrodyneSystems 2:6698a2433bfd 346
AstrodyneSystems 2:6698a2433bfd 347 if(fMainDeploymentAlt < 300)
AstrodyneSystems 2:6698a2433bfd 348 fMainDeploymentAlt = 300;
AstrodyneSystems 2:6698a2433bfd 349 else if(fMainDeploymentAlt > 2000)
AstrodyneSystems 2:6698a2433bfd 350 fMainDeploymentAlt = 2000;
AstrodyneSystems 2:6698a2433bfd 351
AstrodyneSystems 2:6698a2433bfd 352 // save config file if not found?
AstrodyneSystems 2:6698a2433bfd 353
AstrodyneSystems 2:6698a2433bfd 354 }