CPS_Lab* / Mbed 2 deprecated AltTest2

Lab 7

Dependencies:   MPL3115A2 mbed

Fork of AltTest2 by CPS_Lab*

main.cpp@5:96b831624184, 2018-03-07 (annotated)

Committer:
youngs2
Date:
Wed Mar 07 17:42:34 2018 +0000
Revision:
5:96b831624184
Parent:
4:eaaf67c5e1ca 
Lab 7 Final Verison

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ajwhelan 0:d7735965d4ca 1 #include "mbed.h"
ajwhelan 0:d7735965d4ca 2 #include "MPL3115A2.h"
ajwhelan 0:d7735965d4ca 3 #include <string.h>
ajwhelan 0:d7735965d4ca 4 #include <stdlib.h>
youngs2 4:eaaf67c5e1ca 5
ajwhelan 0:d7735965d4ca 6 Serial pc(SERIAL_TX, SERIAL_RX);
ajwhelan 0:d7735965d4ca 7 DigitalOut myled(LED1);
youngs2 4:eaaf67c5e1ca 8 DigitalIn lever(PA_12); //D2 'on' = 1
ajwhelan 0:d7735965d4ca 9 MPL3115A2 pressure_sensor(PB_7,PB_6,0x60);
ajwhelan 0:d7735965d4ca 10
youngs2 4:eaaf67c5e1ca 11 //LocalFileSystem local("local");
youngs2 4:eaaf67c5e1ca 12
youngs2 4:eaaf67c5e1ca 13 /*returns max speed given array of altitudes and length*/
youngs2 4:eaaf67c5e1ca 14 double calcspeed(double j, double *altitude)
youngs2 4:eaaf67c5e1ca 15 {
youngs2 4:eaaf67c5e1ca 16 int i;
youngs2 4:eaaf67c5e1ca 17 double tmp, maxspeed =0;
youngs2 4:eaaf67c5e1ca 18 for(i = 1; i < j; i++)
youngs2 4:eaaf67c5e1ca 19 {
youngs2 4:eaaf67c5e1ca 20 tmp = (altitude[i] - altitude[i-1]);
youngs2 4:eaaf67c5e1ca 21 if(tmp > maxspeed)
youngs2 4:eaaf67c5e1ca 22 maxspeed = tmp;
youngs2 4:eaaf67c5e1ca 23 }
youngs2 4:eaaf67c5e1ca 24 return(maxspeed);
youngs2 4:eaaf67c5e1ca 25 }
youngs2 4:eaaf67c5e1ca 26
youngs2 5:96b831624184 27 /*
youngs2 5:96b831624184 28 * Writes altitude array to file
youngs2 4:eaaf67c5e1ca 29 void graph(double *alt, int time)
youngs2 4:eaaf67c5e1ca 30 {
youngs2 4:eaaf67c5e1ca 31 FILE *fp = fopen("speed.txt","w");
youngs2 4:eaaf67c5e1ca 32 double speeds[time/2];
youngs2 4:eaaf67c5e1ca 33 int i;
youngs2 4:eaaf67c5e1ca 34 for(i = 1; i < time/2; i++)
youngs2 4:eaaf67c5e1ca 35 speeds[i-1] = alt[i]-alt[i-1];
youngs2 4:eaaf67c5e1ca 36 for(i = 0; i < time/2; i++)
youngs2 4:eaaf67c5e1ca 37 fprintf(fp, "%lf\n\r", speeds[i]);
youngs2 4:eaaf67c5e1ca 38
youngs2 4:eaaf67c5e1ca 39 fclose(fp);
ajwhelan 0:d7735965d4ca 40 }
youngs2 5:96b831624184 41 */
youngs2 4:eaaf67c5e1ca 42
youngs2 4:eaaf67c5e1ca 43 /* returns max speed */
youngs2 4:eaaf67c5e1ca 44 void elevator(void)
youngs2 4:eaaf67c5e1ca 45 {
youngs2 4:eaaf67c5e1ca 46 double alt[100], pressure[100], temp[100];
youngs2 4:eaaf67c5e1ca 47 double maxspeed;
youngs2 4:eaaf67c5e1ca 48 int j=0, i;
youngs2 4:eaaf67c5e1ca 49 printf("Data collection starting\n\r");
youngs2 4:eaaf67c5e1ca 50 while(1)
youngs2 4:eaaf67c5e1ca 51 {
youngs2 4:eaaf67c5e1ca 52 pressure[j] = pressure_sensor.getPressure();
youngs2 4:eaaf67c5e1ca 53 alt[j] = pressure_sensor.getAltitude();
youngs2 4:eaaf67c5e1ca 54 temp[j] = pressure_sensor.getTemperature();
youngs2 4:eaaf67c5e1ca 55 myled = !myled;
youngs2 4:eaaf67c5e1ca 56 j++;
youngs2 4:eaaf67c5e1ca 57 if(lever == 0)
youngs2 4:eaaf67c5e1ca 58 break;
youngs2 4:eaaf67c5e1ca 59 }
youngs2 4:eaaf67c5e1ca 60 printf("Data collection ended\n\r");
youngs2 4:eaaf67c5e1ca 61 printf("Time \t Altitude(m) \t Pressure(hPa) \t Temperature(C)\n\r");
youngs2 4:eaaf67c5e1ca 62 for(i = 0; i < j; i++)
youngs2 4:eaaf67c5e1ca 63 printf("%d \t %lf \t %lf \t %lf\n\r", i, alt[i], pressure[i], temp[i]);
youngs2 4:eaaf67c5e1ca 64 maxspeed = calcspeed(j, alt);
youngs2 4:eaaf67c5e1ca 65 printf("The max speed was: %lf\n\r", maxspeed);
youngs2 4:eaaf67c5e1ca 66 //graph(alt, j);
youngs2 4:eaaf67c5e1ca 67 }
youngs2 4:eaaf67c5e1ca 68
ajwhelan 0:d7735965d4ca 69 int MPL3115A2_reg_print(int start, int length) {
youngs2 4:eaaf67c5e1ca 70 uint8_t value; //the array with the register value
youngs2 4:eaaf67c5e1ca 71
ajwhelan 0:d7735965d4ca 72 if(length == 0)
ajwhelan 0:d7735965d4ca 73 length = 45;
ajwhelan 0:d7735965d4ca 74 int i = start, end = start + length;
ajwhelan 0:d7735965d4ca 75 if(start > 0x2D || start < 0x00)
ajwhelan 0:d7735965d4ca 76 return(-1);
ajwhelan 0:d7735965d4ca 77 if(length < 0)
ajwhelan 0:d7735965d4ca 78 return(-1);
ajwhelan 0:d7735965d4ca 79 if (pressure_sensor.getID()!=0xC4)
ajwhelan 0:d7735965d4ca 80 return(-1);
ajwhelan 0:d7735965d4ca 81 if (end > 46)
ajwhelan 0:d7735965d4ca 82 return(-1);
youngs2 4:eaaf67c5e1ca 83
youngs2 4:eaaf67c5e1ca 84 for( i = start; i <= end; i++) {
ajwhelan 0:d7735965d4ca 85 char name[25];
youngs2 4:eaaf67c5e1ca 86 pressure_sensor.readRegs(i, &value, 8); //read the registers 1 at a time
ajwhelan 0:d7735965d4ca 87 switch (i) {
ajwhelan 0:d7735965d4ca 88 case 0x00:
ajwhelan 0:d7735965d4ca 89 strcpy(name,"MPL_STATUS");
ajwhelan 0:d7735965d4ca 90 break;
ajwhelan 0:d7735965d4ca 91 case 0x01:
ajwhelan 0:d7735965d4ca 92 strcpy(name,"MPL_OUT_P_MSB");
ajwhelan 0:d7735965d4ca 93 break;
ajwhelan 0:d7735965d4ca 94 case 0x02:
ajwhelan 0:d7735965d4ca 95 strcpy(name, "MPL_OUT_P_CSB");
ajwhelan 0:d7735965d4ca 96 break;
ajwhelan 0:d7735965d4ca 97 case 0x03:
ajwhelan 0:d7735965d4ca 98 strcpy(name,"MPL_OUT_P_LSB");
ajwhelan 0:d7735965d4ca 99 break;
ajwhelan 0:d7735965d4ca 100 case 0x04:
ajwhelan 0:d7735965d4ca 101 strcpy(name,"MPL_OUT_T_MSB");
ajwhelan 0:d7735965d4ca 102 break;
ajwhelan 0:d7735965d4ca 103 case 0x05:
ajwhelan 0:d7735965d4ca 104 strcpy(name,"MPL_OUT_T_LSB");
ajwhelan 0:d7735965d4ca 105 break;
ajwhelan 0:d7735965d4ca 106 case 0x06:
ajwhelan 0:d7735965d4ca 107 strcpy(name,"MPL_DR_STATUS");
ajwhelan 0:d7735965d4ca 108 break;
ajwhelan 0:d7735965d4ca 109 case 0x07:
ajwhelan 0:d7735965d4ca 110 strcpy(name,"MPL_OUT_P_DELTA_MSB");
ajwhelan 0:d7735965d4ca 111 break;
ajwhelan 0:d7735965d4ca 112 case 0x08:
ajwhelan 0:d7735965d4ca 113 strcpy(name,"MPL_OUT_P_DELTA_CSB");
ajwhelan 0:d7735965d4ca 114 break;
ajwhelan 0:d7735965d4ca 115 case 0x09:
ajwhelan 0:d7735965d4ca 116 strcpy(name,"MPL_OUT_P_DELTA_LSB");
ajwhelan 0:d7735965d4ca 117 break;
ajwhelan 0:d7735965d4ca 118 case 0x0A:
ajwhelan 0:d7735965d4ca 119 strcpy(name,"MPL_OUT_T_DELTA_MSB");
ajwhelan 0:d7735965d4ca 120 break;
ajwhelan 0:d7735965d4ca 121 case 0x0B:
ajwhelan 0:d7735965d4ca 122 strcpy(name,"MPL_OUT_T_DELTA_LSB");
ajwhelan 0:d7735965d4ca 123 break;
ajwhelan 0:d7735965d4ca 124 case 0x0C:
ajwhelan 0:d7735965d4ca 125 strcpy(name,"MPL_WHO_AM_I");
ajwhelan 0:d7735965d4ca 126 break;
ajwhelan 0:d7735965d4ca 127 case 0x0D:
ajwhelan 0:d7735965d4ca 128 strcpy(name,"MPL_F_STATUS");
ajwhelan 0:d7735965d4ca 129 break;
ajwhelan 0:d7735965d4ca 130 case 0x0E:
ajwhelan 0:d7735965d4ca 131 strcpy(name,"MPL_F_DATA");
ajwhelan 0:d7735965d4ca 132 break;
ajwhelan 0:d7735965d4ca 133 case 0x0F:
ajwhelan 0:d7735965d4ca 134 strcpy(name,"MPL_F_SETUP");
ajwhelan 0:d7735965d4ca 135 break;
ajwhelan 0:d7735965d4ca 136 case 0x10:
ajwhelan 0:d7735965d4ca 137 strcpy(name,"MPL_TIME_DLY");
ajwhelan 0:d7735965d4ca 138 break;
ajwhelan 0:d7735965d4ca 139 case 0x11:
ajwhelan 0:d7735965d4ca 140 strcpy(name,"MPL_SYSMOD");
ajwhelan 0:d7735965d4ca 141 break;
ajwhelan 0:d7735965d4ca 142 case 0x12:
ajwhelan 0:d7735965d4ca 143 strcpy(name,"MPL_INT_SOURCE");
ajwhelan 0:d7735965d4ca 144 break;
ajwhelan 0:d7735965d4ca 145 case 0x13:
ajwhelan 0:d7735965d4ca 146 strcpy(name,"MPL_PT_DATA_CFG");
ajwhelan 0:d7735965d4ca 147 break;
ajwhelan 0:d7735965d4ca 148 case 0x14:
ajwhelan 0:d7735965d4ca 149 strcpy(name,"MPL_BAR_IN_MSB");
ajwhelan 0:d7735965d4ca 150 break;
ajwhelan 0:d7735965d4ca 151 case 0x15:
ajwhelan 0:d7735965d4ca 152 strcpy(name,"MPL_BAR_IN_LSB");
ajwhelan 0:d7735965d4ca 153 break;
ajwhelan 0:d7735965d4ca 154 case 0x16:
ajwhelan 0:d7735965d4ca 155 strcpy(name,"MPL_P_TGT_MSB");
ajwhelan 0:d7735965d4ca 156 break;
ajwhelan 0:d7735965d4ca 157 case 0x17:
ajwhelan 0:d7735965d4ca 158 strcpy(name,"MPL_P_TGT_LSB");
ajwhelan 0:d7735965d4ca 159 break;
ajwhelan 0:d7735965d4ca 160 case 0x18:
ajwhelan 0:d7735965d4ca 161 strcpy(name,"MPL_T_TGT");
ajwhelan 0:d7735965d4ca 162 break;
ajwhelan 0:d7735965d4ca 163 case 0x19:
ajwhelan 0:d7735965d4ca 164 strcpy(name,"MPL_P_WND_MSB");
ajwhelan 0:d7735965d4ca 165 break;
ajwhelan 0:d7735965d4ca 166 case 0x1A:
ajwhelan 0:d7735965d4ca 167 strcpy(name,"MPL_P_WND_LSB");
ajwhelan 0:d7735965d4ca 168 break;
ajwhelan 0:d7735965d4ca 169 case 0x1B:
ajwhelan 0:d7735965d4ca 170 strcpy(name,"MPL_T_WND");
ajwhelan 0:d7735965d4ca 171 break;
ajwhelan 0:d7735965d4ca 172 case 0x1C:
ajwhelan 0:d7735965d4ca 173 strcpy(name,"MPL_P_MIN_MSB");
ajwhelan 0:d7735965d4ca 174 break;
ajwhelan 0:d7735965d4ca 175 case 0x1D:
ajwhelan 0:d7735965d4ca 176 strcpy(name,"MPL_P_MIN_CSB");
ajwhelan 0:d7735965d4ca 177 break;
ajwhelan 0:d7735965d4ca 178 case 0x1E:
ajwhelan 0:d7735965d4ca 179 strcpy(name,"MPL_P_MIN_LSB");
ajwhelan 0:d7735965d4ca 180 break;
ajwhelan 0:d7735965d4ca 181 case 0x1F:
ajwhelan 0:d7735965d4ca 182 strcpy(name,"MPL_T_MIN_MSB");
ajwhelan 0:d7735965d4ca 183 break;
ajwhelan 0:d7735965d4ca 184 case 0x20:
ajwhelan 0:d7735965d4ca 185 strcpy(name,"MPL_T_MIN_LSB");
ajwhelan 0:d7735965d4ca 186 break;
ajwhelan 0:d7735965d4ca 187 case 0x21:
ajwhelan 0:d7735965d4ca 188 strcpy(name,"MPL_P_MAX_MSB");
ajwhelan 0:d7735965d4ca 189 break;
ajwhelan 0:d7735965d4ca 190 case 0x22:
ajwhelan 0:d7735965d4ca 191 strcpy(name,"MPL_P_MAX_CSB");
ajwhelan 0:d7735965d4ca 192 break;
ajwhelan 0:d7735965d4ca 193 case 0x23:
ajwhelan 0:d7735965d4ca 194 strcpy(name,"MPL_P_MAX_LSB");
ajwhelan 0:d7735965d4ca 195 break;
ajwhelan 0:d7735965d4ca 196 case 0x24:
ajwhelan 0:d7735965d4ca 197 strcpy(name,"MPL_T_MAX_MSB");
ajwhelan 0:d7735965d4ca 198 break;
ajwhelan 0:d7735965d4ca 199 case 0x25:
ajwhelan 0:d7735965d4ca 200 strcpy(name,"MPL_T_MAX_LSB");
ajwhelan 0:d7735965d4ca 201 break;
ajwhelan 0:d7735965d4ca 202 case 0x26:
ajwhelan 0:d7735965d4ca 203 strcpy(name,"MPL_CTRL_REG1");
ajwhelan 0:d7735965d4ca 204 break;
ajwhelan 0:d7735965d4ca 205 case 0x27:
ajwhelan 0:d7735965d4ca 206 strcpy(name,"MPL_CTRL_REG2");
ajwhelan 0:d7735965d4ca 207 break;
ajwhelan 0:d7735965d4ca 208 case 0x28:
ajwhelan 0:d7735965d4ca 209 strcpy(name,"MPL_CTRL_REG3");
ajwhelan 0:d7735965d4ca 210 break;
ajwhelan 0:d7735965d4ca 211 case 0x29:
ajwhelan 0:d7735965d4ca 212 strcpy(name,"MPL_CTRL_REG4");
ajwhelan 0:d7735965d4ca 213 break;
ajwhelan 0:d7735965d4ca 214 case 0x2A:
ajwhelan 0:d7735965d4ca 215 strcpy(name,"MPL_CTRL_REG5");
ajwhelan 0:d7735965d4ca 216 break;
ajwhelan 0:d7735965d4ca 217 case 0x2B:
ajwhelan 0:d7735965d4ca 218 strcpy(name,"MPL_OFF_P");
ajwhelan 0:d7735965d4ca 219 break;
ajwhelan 0:d7735965d4ca 220 case 0x2C:
ajwhelan 0:d7735965d4ca 221 strcpy(name,"MPL_OFF_T");
ajwhelan 0:d7735965d4ca 222 break;
ajwhelan 0:d7735965d4ca 223 case 0x2D:
ajwhelan 0:d7735965d4ca 224 strcpy(name,"MPL_OFF_H");
ajwhelan 0:d7735965d4ca 225 break;
ajwhelan 0:d7735965d4ca 226 default:
ajwhelan 0:d7735965d4ca 227 printf("ERR\n\r");
youngs2 4:eaaf67c5e1ca 228 }
youngs2 4:eaaf67c5e1ca 229 printf("0x%02X: %s = 0x%02X\n\r", i, name, value);
ajwhelan 0:d7735965d4ca 230
ajwhelan 0:d7735965d4ca 231 }
ajwhelan 0:d7735965d4ca 232 return(0);
ajwhelan 0:d7735965d4ca 233 }
youngs2 4:eaaf67c5e1ca 234
youngs2 4:eaaf67c5e1ca 235
ajwhelan 0:d7735965d4ca 236 int main() {
youngs2 4:eaaf67c5e1ca 237 int start, length;
youngs2 4:eaaf67c5e1ca 238 printf("Hola, buenas tardes\n\r");
youngs2 3:93ba3e6cdaf3 239 printf("Enter start: \n\r");
youngs2 3:93ba3e6cdaf3 240 scanf("%d", &start);
youngs2 3:93ba3e6cdaf3 241 printf("Enter length: \n\r");
youngs2 3:93ba3e6cdaf3 242 scanf("%d", &length);
youngs2 4:eaaf67c5e1ca 243 MPL3115A2_reg_print(start, length);
youngs2 4:eaaf67c5e1ca 244 while (1){
youngs2 4:eaaf67c5e1ca 245 if(lever == 1)
youngs2 4:eaaf67c5e1ca 246 elevator();
youngs2 5:96b831624184 247 wait(1);
ajwhelan 1:03565a1413e6 248 }
youngs2 4:eaaf67c5e1ca 249 //no return; while(1) never exited
youngs2 4:eaaf67c5e1ca 250
ajwhelan 0:d7735965d4ca 251 }