Nelson Santos / Mbed 2 deprecated trabalho

Dependencies:   X_NUCLEO_IKS01A1-f255a2c75ecb mbed-rtos mbed

Committer:
nlsantos
Date:
Tue May 17 23:23:38 2016 +0000
Revision:
27:1216b002cbf3
Parent:
25:2197b8bb930c
Child:
28:256ca0a52c76
nm

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jacinta 0:1eaebb55408a 1 #include "mbed.h"
Jacinta 0:1eaebb55408a 2 #include "x_nucleo_iks01a1.h"
Jacinta 2:0b8065489409 3 #include <vector>
Jacinta 0:1eaebb55408a 4 #include "sensor.h"
Jacinta 0:1eaebb55408a 5 #include "userMethods.h"
Jacinta 0:1eaebb55408a 6
nlsantos 25:2197b8bb930c 7 // Mail box
Jacinta 2:0b8065489409 8 Mail<log_data, QUEUESIZE> ExpansionBoard::mail_box;
Jacinta 7:ed4a10ebe720 9 vector<log_data> * ExpansionBoard::v;
Jacinta 7:ed4a10ebe720 10 int * ExpansionBoard::n;
Jacinta 21:849e5636076e 11 bool ExpansionBoard::flag;
Jacinta 0:1eaebb55408a 12
Jacinta 2:0b8065489409 13 //This is the producer
Jacinta 21:849e5636076e 14 void ExpansionBoard::sampleData()
Jacinta 21:849e5636076e 15 {
Jacinta 24:c924342f7c76 16 if(flag) printf("\nAbout to alloc\n");
nlsantos 27:1216b002cbf3 17 log_data* log_d = (log_data*)mail_box.alloc(5000);
Jacinta 21:849e5636076e 18
Jacinta 2:0b8065489409 19 if (log_d == NULL) {
nlsantos 27:1216b002cbf3 20 mail_box.get(5000);
Jacinta 24:c924342f7c76 21 if(flag) printf("Out of memory, last sample deleted\n");
nlsantos 27:1216b002cbf3 22 log_data* log_d = (log_data*)mail_box.alloc(5000);
Jacinta 24:c924342f7c76 23 if(flag) printf("Allocated after out of memory\n");
Jacinta 2:0b8065489409 24 }
Jacinta 21:849e5636076e 25
Jacinta 24:c924342f7c76 26 if(flag) printf("Not null, reading values\n");
Jacinta 2:0b8065489409 27 //Store read data in a sample
Jacinta 2:0b8065489409 28 float value;
Jacinta 2:0b8065489409 29 log_d->date = time(NULL);
Jacinta 2:0b8065489409 30 temp_sensor->GetTemperature(&value);
Jacinta 2:0b8065489409 31 log_d->tempCelsius = value;
Jacinta 2:0b8065489409 32 humidity_sensor->GetHumidity(&value);
Jacinta 2:0b8065489409 33 log_d->humidity = value;
Jacinta 2:0b8065489409 34 pressure_sensor->GetPressure(&value);
Jacinta 2:0b8065489409 35 log_d->pressure = value;
Jacinta 24:c924342f7c76 36 if(flag) printf("All values STORED\n");
Jacinta 2:0b8065489409 37 //Send pointer to sample to the queue
Jacinta 2:0b8065489409 38 osStatus stat = mail_box.put(log_d);
Jacinta 24:c924342f7c76 39 //v->push_back(*log_d);
Jacinta 21:849e5636076e 40
Jacinta 24:c924342f7c76 41 if(flag) printf("MAIL_BOX.PUT run\n");
Jacinta 2:0b8065489409 42 // Check for resource error
Jacinta 2:0b8065489409 43 if (stat == osErrorResource) {
Jacinta 24:c924342f7c76 44 if(flag) printf("mail_box->put() Error %4Xh\n", stat);
Jacinta 2:0b8065489409 45 //Error, free up memory block taken
Jacinta 2:0b8065489409 46 mail_box.free(log_d);
Jacinta 2:0b8065489409 47 }
Jacinta 2:0b8065489409 48 }
Jacinta 2:0b8065489409 49
nlsantos 25:2197b8bb930c 50 // This is the consumer
Jacinta 24:c924342f7c76 51 /*
Jacinta 21:849e5636076e 52 void ExpansionBoard::getData(const void*)
Jacinta 21:849e5636076e 53 {
Jacinta 7:ed4a10ebe720 54
Jacinta 21:849e5636076e 55 while(true) {
Jacinta 2:0b8065489409 56 //Block on queue if no data is available
Jacinta 2:0b8065489409 57 osEvent event = mail_box.get();
Jacinta 21:849e5636076e 58 if(flag) {
Jacinta 21:849e5636076e 59 printf("MAIL_BOX.GET\n");
Jacinta 21:849e5636076e 60 }
Jacinta 21:849e5636076e 61
Jacinta 2:0b8065489409 62 if (event.status == osEventMail) {
Jacinta 2:0b8065489409 63 // Successful, store log_data
Jacinta 2:0b8065489409 64 log_data* temp = (log_data*) event.value.p;
Jacinta 7:ed4a10ebe720 65 v->push_back(*temp);
Jacinta 2:0b8065489409 66 mail_box.free(temp);
Jacinta 21:849e5636076e 67 if(flag) {
Jacinta 21:849e5636076e 68 printf("GET value stored and freed up mail_box\n");
Jacinta 21:849e5636076e 69 }
Jacinta 2:0b8065489409 70 }
Jacinta 2:0b8065489409 71 }
Jacinta 2:0b8065489409 72 }
Jacinta 24:c924342f7c76 73 */
Jacinta 2:0b8065489409 74
Jacinta 2:0b8065489409 75 // Helper function for printing floats & doubles
Jacinta 21:849e5636076e 76 char *ExpansionBoard::printDouble(char* str, double v, int decimalDigits)
Jacinta 21:849e5636076e 77 {
Jacinta 2:0b8065489409 78 int intPart, fractPart, len, i=1;
Jacinta 0:1eaebb55408a 79 char *ptr;
Jacinta 0:1eaebb55408a 80 for (; decimalDigits!=0; i*=10, decimalDigits--);
Jacinta 0:1eaebb55408a 81 intPart = (int)v;
Jacinta 0:1eaebb55408a 82 fractPart = (int)((v-(double)(int)v)*i);
Jacinta 0:1eaebb55408a 83 sprintf(str, "%i.", intPart);
Jacinta 0:1eaebb55408a 84 len = strlen(str);
Jacinta 0:1eaebb55408a 85 ptr = &str[len];
Jacinta 0:1eaebb55408a 86 for (i/=10; i>1; i/=10, ptr++) {
Jacinta 0:1eaebb55408a 87 if(fractPart >= i) break;
Jacinta 0:1eaebb55408a 88 *ptr = '0';
Jacinta 0:1eaebb55408a 89 }
Jacinta 0:1eaebb55408a 90 sprintf(ptr, "%i", fractPart);
Jacinta 0:1eaebb55408a 91 return str;
Jacinta 0:1eaebb55408a 92 }
Jacinta 0:1eaebb55408a 93
nlsantos 25:2197b8bb930c 94 // Constructor for the class
Jacinta 21:849e5636076e 95 ExpansionBoard::ExpansionBoard(vector<log_data> vector, int num, bool lFlag): T(15.0f)
Jacinta 21:849e5636076e 96 {
Jacinta 7:ed4a10ebe720 97 v = &vector;
Jacinta 7:ed4a10ebe720 98 n = &num;
Jacinta 20:014a808b3ea2 99 flag = &lFlag;
Jacinta 21:849e5636076e 100
Jacinta 21:849e5636076e 101 /* Retrieve the composing elements of the expansion board */
Jacinta 20:014a808b3ea2 102 printf("Initialising expansion board...\n\r");
Jacinta 2:0b8065489409 103 }