James Novak
10Hz GPS, MEgasquirt, SD Card, ADxl345, 20x4 LCD datalogger
Dependencies: ADXL345 10HzGPSdatalogger mbed
Diff: main.cpp
- Revision:
- 0:b8d7df90819e
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Sat Nov 28 17:07:15 2015 +0000
@@ -0,0 +1,804 @@
+//Code Designed to display run-time variables from a Megasquirt Fuel Injection controller.
+//This is the base code to load variables and print to LCD and write them to a file. File format is .FRD for import into EFI Analytics tuner Studio
+
+#include "mbed.h"
+#include "gps.h" //////////////////////include for GPS Code /////////////////////////////
+#include "data.h" //////////////////////include for GPS Code /////////////////////////////
+#include "TextLCD.h"
+#include "SDFileSystem.h"
+#include "SerialBuffered.h"
+#include "ADXL345.h"
+
+
+//SD Card pin assignment
+SDFileSystem sd(p11, p12, p13, p14, "sd");//DI, D0, SCK, CS
+
+//local file system.
+
+LocalFileSystem local("local");
+
+
+
+AnalogIn SDenable(p20);//define SD card switch
+DigitalOut myled1(LED1);//define LED
+Serial loggerSerial(USBTX, USBRX);
+Timer t;
+
+
+Serial pc(USBTX, USBRX);
+TextLCD lcd(p21, p22, p23, p24, p25, p26, p30, 20 ,4); //Define LCD pins
+
+
+
+//Acclerometer - SparkFun ADXL345 16G pin assignment
+ADXL345 accelerometer(p5, p6, p7, p8); //SPI DI, D0, SCK, CS
+
+//Serial usb(USBTX, USBRX); //define USB connection pins
+SerialBuffered megasquirt(120, p28, p27); // RS232 TX/RX that 120 is the size of the read buffer it will make for you
+
+DigitalOut usb_activity(LED1); //define USB activity
+DigitalOut megasquirt_activity(LED2); //define Megasquirt activity
+
+
+int column;
+int row;
+int i;
+char c;
+int dataflag;
+
+/////////////////////////////////////Define GPS Variables//////////////////////////////////
+float time1;
+char statusGPS;
+float Lat1;
+float Long1;
+char Lat_h1;
+char Long_h1;
+float time_GPS1;
+float speed_k1;
+float speed_mph1;
+float heading1;
+
+
+///////////////////define buffers//////////////////////////
+unsigned char tmp_data[16];
+int tmp;
+unsigned char buf[120];
+float Time;
+
+
+
+////////////////////////////define MS variables////////////////////////
+long float SecL; //get secoonds
+long float PW;//get pulseWidth1
+long float PW2; //get pulseWidth2
+int RPM; //get Rpm
+int DutyCycle; //Injector Duty Cycle
+int DutyCycle2; //Injector Bank2 Duty Cycle
+long float SparkAdv; //get advance
+float squirt; //get squirt
+float Engine; //get squirt
+float afrtgt1; //get AFR target - Table 1
+float afrtgt2; //get AFR target - Table 2
+float wbo2_en1; //get WideBand Valid1
+float wbo2_en2; //get WideBand Valid2
+long float barometer; //get Barometer
+long float MAP; //get manifold absolute pressure MAP
+long float MAT; //get manifold absolute temperature (MAT)
+long float CLT; //get coolant temperature (CLT)
+long float TP; //get Throttle Position Sensor (TPS)
+long float vBatt; //get BAttery Voltage
+long float AFR; //get Realtime AFR for VE1
+long float AFR2; //get Realtime AFR for VE2
+long float knock; //get Knock Threshold Value
+long float Gego; //get egoCorrrection1 amount %
+long float Gego2; //get egoCorrrection2 amount %
+long float Gair; //get air correction (G_air)
+long float Gwarmup; //get Warmup Enrichment
+long float TPSacc; //get accel enrichment (ms)
+long float TPScut; //get TPS based fuel cut %
+long float Gbaro; //get baroCorrection %
+long float Gammae; //get gammaEnrich %
+long float veCurr1; //get Current VE value Table 1
+long float veCurr2; //get Current VE value Table 2
+long float IAC; //get IAC Step %
+long float ColdAdv; //get Cold Ignition Advance
+long float tpsDOT; //get Rate of Change TPS
+long float mapDOT; //get Rate of Change MAP
+long float Dwell; //get Ignition Dwell
+long float maf; //get MAF - Mass Air Flow
+long float fuelload; //get MAP/TPS Blend %
+long float Ethanol; //get fuel load percent alchohol
+char portstatus; //get Spare Port Status
+char knockRetard; //get Knock timing retard (deg)
+long float EAEFuelCorr; //get EAE Fuel correction
+long float egoV; //get egoV
+long float egoV2; //get egoV2
+char status1; //get Status1
+char status2; //get Status2
+char status3; //get Status3
+char status4; //get Status4
+long float looptime; //get looptime
+char status5; //get Status5
+long float tpsADC; //get tpsADC
+long float fuelload2; //get fuelload2
+long float ignload; //get ignload
+long float ignload2; //get ignload2
+char syncstatus; //get Sync-Status (0 - sync-error, 1 - syncstatus)
+float deltaT; //get deltaT
+long float wallfuel; //get wallfuel
+
+int runtime;
+unsigned char data_out;
+int n;
+char MSII_288Header[] = {0x46,0x52,0x44,0x00,0x00,0x00,0x00,0x01,0x4b,0x61,0xf1,0x63,0x4d,0x53,0x49,0x49,0x20,0x52,0x65,0x76,0x20,0x32,0x2e,0x38,0x38,0x30,0x30,0x30,0x20,0x20,0x20,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x51,0x00,0x70};//file header
+char MSIIExtraHeader[] = {0x46,0x52,0x44,0x00,0x00,0x00,0x00,0x01,0x4b,0x6a,0xf3,0xa8,0x4d,0x53,0x32,0x45,0x78,0x74,0x72,0x61,0x20,0x52,0x65,0x6c,0x20,0x32,0x2e,0x31,0x2e,0x31,0x62,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x51,0x00,0x91};
+char parse_header[] = {0x01,0x00};//data header
+
+//////////////////////////define accelerometer variables/////////////////////
+float x1;// new variable for math for acceleration parameters
+float y1;// new variable for math for acceleration parameters
+float z1;// new variable for math for acceleration parameters
+float x2;// new variable for math for acceleration parameters
+float y2;// new variable for math for acceleration parameters
+float z2;// new variable for math for acceleration parameters
+
+/////////////////////////define accelerometer variables/////////////////////
+int readings[3] = {0, 0, 0};
+float XaccelADC;
+float YaccelADC;
+float ZaccelADC;
+float Xaccel_g;
+float Yaccel_g;
+float Zaccel_g;
+
+
+
+
+/*LCD 4x20 parallel code pin assignment*/
+//TextLCD lcd(p21, p22, p23, p24, p25, p26, p30, 20, 4); // (rs, rw, e, d0, d1, d2, d3, n_column, n_rows)
+//define file write
+//AnalogIn file_writeenable(p20);//define SD card switch
+
+
+//enter main loop
+int main()
+{ ////start main program loop
+
+//Acceleromater setup
+
+ //Go into standby mode to configure the device.
+ accelerometer.setPowerControl(0x00);
+
+ //Full resolution, +/-16g, 4mg/LSB.
+ accelerometer.setDataFormatControl(0x0B);
+
+ //3.2kHz data rate.
+ accelerometer.setDataRate(ADXL345_3200HZ);
+
+ //Measurement mode.
+ accelerometer.setPowerControl(0x08);
+
+
+ ///////////////////////////GPS setup////////////////////
+
+
+ pc.baud(115200);
+ gps.baud(115200); //////////////////////include for GPS Code /////////////////////////////
+
+
+/////Startup Screen////////////
+ lcd.cls();
+//lcd.init_Display();
+//DigitalOut myled(LED1);
+ lcd.cls();
+ lcd.printf(" Dashview V3 ");
+ wait(1.5);
+ lcd.cls();
+ lcd.printf(" Hello ");
+ wait(0.5);
+ lcd.locate(0,1);
+ lcd.printf("Have A Great Drive");
+ wait(2.0);
+ lcd.cls();
+
+
+////////////End Startup Screen//////////
+
+
+
+ megasquirt.baud(115200); //define MEgasquirt serial speed
+ loggerSerial.baud(115200); //define connection speed
+
+// unsigned char tmp;
+// unsigned char data_in;
+
+
+/////////file header setup
+/////Setup file header for Datalog.
+/////File header is comma delimited for import to Excel or most video editing software overaly.
+
+ FILE *fp = fopen("/sd/datalog.csv", "a");
+ //print header for MS.csv file
+ fprintf(fp, "MSII Rev 2.88000, \ntime1,Lat1,Long1,speed_mph1,heading1,Xaccel_g, Yaccel_g, Zaccel_g,\n");
+ fclose(fp);
+
+ t.start();
+ dataflag=0;
+ i = 0;
+ while (1) { ///start functional loop
+
+////////turn on swtich to Pin 20 to write to SD card///////////////
+////////file formate is .csv for import into Excel and also MegaLog Viewer
+ if (SDenable > 0.5) { //switch enable = ON
+ dataflag = 1;
+ myled1 = 1;
+// printf("Opening File...\n"); // Drive should be marked as removed
+ FILE *fp = fopen("/sd/datalog.csv", "a"); ///open file
+ //write xls buffer from Megasquirt
+
+ if(fp == NULL) {
+ error("Could not open file for write\n");
+ }
+ //if (dataflag == 1) {
+///////Begin Dataflag loop//////////////////
+
+// for (i = 0; i<5 ; i++)
+//{
+ ///start for loop count
+/////////////////BEGIN DATA COLLECTION LOOP #1/////////////////////////////////////
+
+ ///////////////////////////////GPS Code/////////////////////////////////////
+
+ getGPSstring(1);
+
+///////convert string format to floating to perform math functions /////////////////////
+ if (sscanf(gpsString, "$GPRMC,%s",rmc1) >= 1) {
+ sep = 0;
+ parseRMC();
+ sscanf(time_GPS, "%f", &time1);
+ sscanf(status, "%c", &statusGPS);
+ sscanf(Lat, "%f", &Lat1);
+ sscanf(Lat_h, "%c", &Lat_h1);
+ sscanf(Long, "%f", &Long1);
+ sscanf(Long_h, "%c", &Long_h1);
+ sscanf(time_GPS, "%f", &time_GPS1);
+ sscanf(speed_k, "%f", &speed_k1);
+ sscanf(heading, "%f", &heading1);
+
+ }
+
+
+ speed_mph1 = speed_k1 * 1.15077; ////convert Knots to mph
+ Lat1 = Lat1/100; /////Convert format for google maps overlay
+ Long1 = Long1/-100; /////Convert format for google maps overlay
+
+ lcd.locate(10,1);
+ lcd.printf("Spd:%4.1f", speed_mph1);
+ //pc.printf("time:%8.1f Lat:%9.6f Long:%9.6f Spd:%4.1f heading:%5.1f \r\n",time1,Lat1,Long1,speed_mph1,heading1);
+
+
+ ///////////////////////////////////End GPS Code///////////////////////////////////////////////
+
+
+
+///////////////Accelerometer code begin here////////////////////////////////////
+ {
+ accelerometer.getOutput(readings);
+
+ XaccelADC = (int16_t)readings[0];
+ YaccelADC = (int16_t)readings[1];
+ ZaccelADC = (int16_t)readings[2];
+
+ Xaccel_g = (XaccelADC/256);
+ Yaccel_g = (YaccelADC/256);
+ Zaccel_g = (ZaccelADC/256);
+
+
+// uncommment to display Accelerometer
+
+
+// lcd.locate(0,0);/// define LCD location
+// lcd.printf("%4.2f, %4.2f, %4.2f", Xaccel_g, Yaccel_g, Zaccel_g);
+
+///////Lateral Acceleration bar Graph ///////////////////////
+
+///////////////X-direction accleration bar graph/////////////////
+ /*
+ x1 = Xaccel_g * 10;//scale one g to display resolution
+ if (x1 < 0);//for negative g values
+ {
+ x2 = 10 + x1;//offset negative values for positive graph
+ lcd.locate(0,3); /// define LCD location
+ for (i=0; i<10; i++) {
+ if (i < x2) lcd.putc(0x20);//write single space character
+ else lcd.putc(0xFF);//write single clock space
+ }
+ }
+
+ if (x1 > 0);//for positive g values
+ {
+ lcd.locate(10,3);/// define LCD location
+ for (i=0; i<10; i++) {
+ if (i < x1) lcd.putc(0xFF);//write single block character
+ else lcd.putc(0x20);//write single blank space
+ }
+ }
+ */
+////////////Forward/Braking Acceleration bar Graph ///////////////////////
+ y1 = Yaccel_g * 10;//scale one g to display resolution
+ if (y1 < 0);//for negative g values
+ {
+ y2 = 10 + y1;//offset negative values for positive graph
+ lcd.locate(0,3); /// define LCD location
+ for (i=0; i<10; i++) {
+ if (i < y2) lcd.putc(0x20);//write single space character
+ else lcd.putc(0xFF);//write single clock space
+ }
+ }
+
+ if (y1 > 0);//for positive g values
+ {
+ lcd.locate(10,3);/// define LCD location
+ for (i=0; i<10; i++) {
+ if (i < y1) lcd.putc(0xFF);//write single block character
+ else lcd.putc(0x20);//write single blank space
+ }
+ }
+ ////////////End Accelerometer code //////////////////////////////////////////////
+
+
+
+
+
+
+ fprintf(fp, "%.3f, %9.6f, %9.6f, %3.1f,%4.1f, %.3f, %.3f, %.3f", time1,Lat1,Long1,speed_mph1,heading1,Xaccel_g, Yaccel_g, Zaccel_g);
+ pc.printf("%.3f, %9.6f, %9.6f, %3.1f,%4.1f, %.3f, %.3f, %.3f, \r\n", time1,Lat1,Long1,speed_mph1,heading1,Xaccel_g, Yaccel_g, Zaccel_g);
+ ////////Get Megasquirt Runtime data buffer//////////////
+
+
+ //poll serial device for data stream (a,0,6) to (request, return, confirm)
+ megasquirt.putc(97);//send 97 for run parameters, 83 for board revision, 81 code for revision number
+ wait(0.005);
+ megasquirt.putc(0);
+ wait(0.005);
+ megasquirt.putc(6);
+ int actuallyRead = megasquirt.readBytes( buf, 112); // where 112 is the number of bytes you are expecting from MSII outpc buffer
+
+
+//decodeMS Runtime Data Buffer();
+
+ Time = t.read();//read value from timer in ms
+
+////////Decode MS Runtime Data Buffer////
+
+////The following code will parse the runtime data buffer from MSExtra-2
+//Position of the runtime bits given on msextra.com
+//Scalar math completed where known
+
+//get seconds - runtime of MS
+ tmp = buf[0];
+ tmp = tmp << 8;
+ SecL = tmp | buf[1];
+ //MSseconds = MSseconds/256;
+//get pulseWidth1
+ tmp = buf[2];
+ tmp = tmp << 8;
+ tmp = tmp | buf[3];
+ PW = tmp*0.000666;
+
+
+//get pulseWidth2
+ tmp = buf[4];
+ tmp = tmp << 8;
+ tmp = tmp | buf[5];
+ PW2 = tmp*0.000666;
+//get Rpm
+ tmp = buf[6];
+ tmp = tmp << 8;
+ RPM = tmp | buf[7];
+
+//Calculate DutyCycle
+ DutyCycle = (PW * (RPM / 60)) / 10;
+
+//Calculate DutyCycle2
+ DutyCycle2 = (PW2 * (RPM / 60)) / 10;
+
+
+//get advance
+ tmp = buf[8];
+ tmp = tmp << 8;
+ tmp = tmp | buf[9];
+ SparkAdv = tmp/10;
+
+//get manifold absolute pressure MAP
+ tmp = buf[18];
+ tmp = tmp << 8;
+ MAP = tmp | buf[19];
+ MAP = MAP/10;
+//get manifold absolute temperature (MAT)
+ tmp = buf[20];
+ tmp = tmp << 8;
+ MAT = tmp | buf[21];
+ MAT = MAT/10; ///for Farenheit
+ // MAT = 0.555*(MAT - 32); //for Celcius
+//get coolant temperature (CLT)
+ tmp = buf[22];
+ tmp = tmp << 8;
+ CLT = tmp | buf[23];
+ CLT = CLT/10;
+ //CLT = 0.555*(CLT - 32); //for Celciuss
+//get Throttle Position Sensor (TPS)
+ tmp = buf[24];
+ tmp = tmp << 8;
+ TP = tmp | buf[25];
+ TP = TP / 10;
+//get BAttery Voltage
+ tmp = buf[26];
+ tmp = tmp << 8;
+ vBatt = tmp | buf[27];
+ vBatt = vBatt /10,
+//get Realtime AFR for VE1
+ tmp = buf[28];
+ tmp = tmp << 8;
+ AFR = tmp | buf[29];
+ AFR = AFR /10;
+//
+/////////////// Print Display Variables //////////////////
+
+
+
+///print bargraph of TPS
+ /* lcd.locate(15,1);
+ // for (i=0; i<20; i++){
+ // if (i<TPS) lcd.printf(0xFF);
+ // else lcd.printf(0x20);
+ // }
+ lcd.printf("%i ",TPS);
+ */
+
+//get Rpm
+
+ lcd.locate(0,0);
+ lcd.printf("RPM= %i ",RPM);
+
+//get AFR
+
+ //AFR = tmp/10;
+ lcd.locate(10,0);
+ lcd.printf("AFR= %4.1f", AFR);
+
+//get Map
+
+ //MAP = MAP/10;
+ ///will print MAP at atmospheric and Boost on turbo (Bar)
+ if (MAP >100) {
+ MAP = (MAP - 100)/100;
+ lcd.locate (0,1);
+ lcd.printf("%.1f Bar",MAP);
+ } else {
+ lcd.locate(0,1);
+ lcd.printf("MAP= %4.1f", MAP);
+ }
+
+//get Clt
+
+ //CLT = CLT/10;
+ lcd.locate(0,2);
+ if (CLT < 120) {
+ lcd.printf(" Warm Up ");
+ } else {
+ lcd.printf("CLT= %4.1f", CLT);
+ }
+
+//get MAT
+ lcd.locate(10,2);
+ lcd.printf("MAT= %4.1f", MAT);
+
+//////////////Template to print variable///////////
+//Use code to add variable to display output /////
+ /*
+ //get Variable
+
+ //MAP = MAP/10;
+ lcd.locate(10,1); position on LCD
+ lcd.printf("Variable= %4.1f", Variable); //format print X.Y is number of data characters total and how many are past decimal point
+
+ */
+/////////////////////////end MS Code////////////////////////////////
+fprintf(fp, "%8.3f, %i, %4.1f, %3f, %4.1f, %4.1f, %5.1f, %5.1f, %f, %.3f, %.3f,\r\n", Time, RPM, MAP, TP, vBatt, AFR, MAT, CLT, PW, DutyCycle, SparkAdv);
+
+/////////////////END DATA COLLECTION LOOP #1/////////////////////////////////////
+
+
+
+ } ///end for loop count
+
+
+
+ //pc.printf("print complete");//debug statement
+
+ ///////end Dataflag loop//////////////////
+
+
+
+
+ //pc.printf("close file"); // debug statement
+
+ fclose(fp); ///close file
+ dataflag = 0; //close flag and reset counter
+ i=0; ///reset counter i
+ ///end datalog - return to function
+
+
+ } // end switch enable loop
+
+ //
+// else //If switch NOT enabled begin else loop 2
+
+// {
+ myled1 = 0;
+ /////////////////BEGIN DATA COLLECTION LOOP #2/////////////////////////////////////
+
+
+ ///////////////////////////////GPS Code/////////////////////////////////////
+ getGPSstring(1);
+
+///////convert string format to floating to perform math functions /////////////////////
+ if (sscanf(gpsString, "$GPRMC,%s",rmc1) >= 1) {
+ sep = 0;
+ parseRMC();
+ sscanf(time_GPS, "%f", &time1);
+ sscanf(Lat, "%f", &Lat1);
+ sscanf(Lat_h, "%c", &Lat_h1);
+ sscanf(Long, "%f", &Long1);
+ sscanf(Long_h, "%c", &Long_h1);
+ sscanf(time_GPS, "%f", &time_GPS1);
+ sscanf(speed_k, "%f", &speed_k1);
+ sscanf(heading, "%f", &heading1);
+
+ }
+
+
+ speed_mph1 = speed_k1 * 1.15077; ////convert Knots to mph
+ Lat1 = Lat1/100; /////Convert format for google maps overlay
+ Long1 = Long1/-100; /////Convert format for google maps overlay
+
+ lcd.locate(10,1);
+ lcd.printf("Spd:%4.1f ", speed_mph1);
+ //pc.printf("time:%8.1f Lat:%9.6f Long:%9.6f Spd:%4.1f heading:%5.1f %.3f, %.3f, %.3f \r\n",time1,Lat1,Long1,speed_mph1,heading1,Xaccel_g, Yaccel_g, Zaccel_g, );
+
+ ///////////////////////////////////End GPS Code///////////////////////////////////////////////
+
+
+ ///////////////Accelerometer code begin here////////////////////////////////////
+
+ accelerometer.getOutput(readings);
+
+ XaccelADC = (int16_t)readings[0];
+ YaccelADC = (int16_t)readings[1];
+ ZaccelADC = (int16_t)readings[2];
+
+ Xaccel_g = (XaccelADC/256);
+ Yaccel_g = (YaccelADC/256);
+ Zaccel_g = (ZaccelADC/256);
+
+
+// uncommment to display Accelerometer
+
+
+// lcd.locate(0,0);/// define LCD location
+// lcd.printf("%4.2f, %4.2f, %4.2f", Xaccel_g, Yaccel_g, Zaccel_g);
+
+///////Lateral Acceleration bar Graph ///////////////////////
+
+///////////////X-direction accleration bar graph/////////////////
+ /*
+ x1 = Xaccel_g * 10;//scale one g to display resolution
+ if (x1 < 0);//for negative g values
+ {
+ x2 = 10 + x1;//offset negative values for positive graph
+ lcd.locate(0,3); /// define LCD location
+ for (i=0; i<10; i++) {
+ if (i < x2) lcd.putc(0x20);//write single space character
+ else lcd.putc(0xFF);//write single clock space
+ }
+ }
+
+ if (x1 > 0);//for positive g values
+ {
+ lcd.locate(10,3);/// define LCD location
+ for (i=0; i<10; i++) {
+ if (i < x1) lcd.putc(0xFF);//write single block character
+ else lcd.putc(0x20);//write single blank space
+ }
+ }
+ */
+////////////Forward/Braking Acceleration bar Graph ///////////////////////
+ y1 = Yaccel_g * 10;//scale one g to display resolution
+ if (y1 < 0);//for negative g values
+ {
+ y2 = 10 + y1;//offset negative values for positive graph
+ lcd.locate(0,3); /// define LCD location
+ for (i=0; i<10; i++) {
+ if (i < y2) lcd.putc(0x20);//write single space character
+ else lcd.putc(0xFF);//write single clock space
+ }
+ }
+
+ if (y1 > 0);//for positive g values
+ {
+ lcd.locate(10,3);/// define LCD location
+ for (i=0; i<10; i++) {
+ if (i < y1) lcd.putc(0xFF);//write single block character
+ else lcd.putc(0x20);//write single blank space
+ }
+ }
+
+
+ pc.printf("%.3f, %9.6f, %9.6f, %3.1f,%4.1f, %.3f, %.3f, %.3f, \r\n", time1,Lat1,Long1,speed_mph1,heading1,Xaccel_g, Yaccel_g, Zaccel_g);
+ ////////Get Megasquirt Runtime data buffer//////////////
+
+
+ //poll serial device for data stream (a,0,6) to (request, return, confirm)
+ megasquirt.putc(97);//send 97 for run parameters, 83 for board revision, 81 code for revision number
+ wait(0.005);
+ megasquirt.putc(0);
+ wait(0.005);
+ megasquirt.putc(6);
+ int actuallyRead = megasquirt.readBytes( buf, 112); // where 112 is the number of bytes you are expecting from MSII outpc buffer
+
+
+//decodeMS Runtime Data Buffer();
+
+ Time = t.read();//read value from timer in ms
+
+////////Decode MS Runtime Data Buffer////
+
+////The following code will parse the runtime data buffer from MSExtra-2
+//Position of the runtime bits given on msextra.com
+//Scalar math completed where known
+
+//get seconds - runtime of MS
+ tmp = buf[0];
+ tmp = tmp << 8;
+ SecL = tmp | buf[1];
+ //MSseconds = MSseconds/256;
+//get pulseWidth1
+ tmp = buf[2];
+ tmp = tmp << 8;
+ tmp = tmp | buf[3];
+ PW = tmp*0.000666;
+
+
+//get pulseWidth2
+ tmp = buf[4];
+ tmp = tmp << 8;
+ tmp = tmp | buf[5];
+ PW2 = tmp*0.000666;
+//get Rpm
+ tmp = buf[6];
+ tmp = tmp << 8;
+ RPM = tmp | buf[7];
+
+//Calculate DutyCycle
+ DutyCycle = (PW * (RPM / 60)) / 10;
+
+//Calculate DutyCycle2
+ DutyCycle2 = (PW2 * (RPM / 60)) / 10;
+
+
+//get advance
+ tmp = buf[8];
+ tmp = tmp << 8;
+ tmp = tmp | buf[9];
+ SparkAdv = tmp/10;
+
+//get manifold absolute pressure MAP
+ tmp = buf[18];
+ tmp = tmp << 8;
+ MAP = tmp | buf[19];
+ MAP = MAP/10;
+//get manifold absolute temperature (MAT)
+ tmp = buf[20];
+ tmp = tmp << 8;
+ MAT = tmp | buf[21];
+ MAT = MAT/10; ///for Farenheit
+ // MAT = 0.555*(MAT - 32); //for Celcius
+//get coolant temperature (CLT)
+ tmp = buf[22];
+ tmp = tmp << 8;
+ CLT = tmp | buf[23];
+ CLT = CLT/10;
+ //CLT = 0.555*(CLT - 32); //for Celciuss
+//get Throttle Position Sensor (TPS)
+ tmp = buf[24];
+ tmp = tmp << 8;
+ TP = tmp | buf[25];
+ TP = TP / 10;
+//get BAttery Voltage
+ tmp = buf[26];
+ tmp = tmp << 8;
+ vBatt = tmp | buf[27];
+ vBatt = vBatt /10,
+//get Realtime AFR for VE1
+ tmp = buf[28];
+ tmp = tmp << 8;
+ AFR = tmp | buf[29];
+ AFR = AFR /10;
+//
+/////////////// Print Display Variables //////////////////
+
+
+
+///print bargraph of TPS
+ /* lcd.locate(15,1);
+ // for (i=0; i<20; i++){
+ // if (i<TPS) lcd.printf(0xFF);
+ // else lcd.printf(0x20);
+ // }
+ lcd.printf("%i ",TPS);
+ */
+
+//get Rpm
+
+ lcd.locate(0,0);
+ lcd.printf("RPM= %i ",RPM);
+
+//get AFR
+
+ //AFR = tmp/10;
+ lcd.locate(10,0);
+ lcd.printf("AFR= %4.1f", AFR);
+
+//get Map
+
+ //MAP = MAP/10;
+ ///will print MAP at atmospheric and Boost on turbo (Bar)
+ if (MAP >100) {
+ MAP = (MAP - 100)/100;
+ lcd.locate (0,1);
+ lcd.printf("%.1f Bar",MAP);
+ } else {
+ lcd.locate(0,1);
+ lcd.printf("MAP= %4.1f", MAP);
+ }
+
+//get Clt
+
+ //CLT = CLT/10;
+ lcd.locate(0,2);
+ if (CLT < 120) {
+ lcd.printf(" Warm Up ");
+ } else {
+ lcd.printf("CLT= %4.1f", CLT);
+ }
+
+//get MAT
+ lcd.locate(10,2);
+ lcd.printf("MAT= %4.1f", MAT);
+
+//////////////Template to print variable///////////
+//Use code to add variable to display output /////
+ /*
+ //get Variable
+
+ //MAP = MAP/10;
+ lcd.locate(10,1); position on LCD
+ lcd.printf("Variable= %4.1f", Variable); //format print X.Y is number of data characters total and how many are past decimal point
+
+ */
+/////////////////////////end MS Code////////////////////////////////
+
+
+
+
+/////////////////END DATA COLLECTION LOOP #2/////////////////////////////////////
+ // } ///end else loop 2
+///////////////end datalog code///////////////////////////////////////////////
+
+ } ///exit while loop
+
+}
+//exit main loop
+
+