02/07/15

Dependencies:   mbed

Dependents:   TabbedGUIMbed

Committer:
aidanPJG
Date:
Wed Jul 08 08:37:07 2015 +0000
Revision:
33:929f1755664b
Parent:
32:792c4239a738
Child:
38:da262dc4f90a
added speed;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
aidanPJG 22:34bc2f2f5b09 1 #include "mbed.h"
aidanPJG 22:34bc2f2f5b09 2 #include <time.h>
aidanPJG 22:34bc2f2f5b09 3 #include <string>
aidanPJG 22:34bc2f2f5b09 4 #include <iostream>
aidanPJG 33:929f1755664b 5 //#include "Distance.h"
aidanPJG 31:bea1117f14fb 6
aidanPJG 19:a3edf2c547e1 7 //mbed pins
aidanPJG 26:4289549b2d21 8 extern Serial pc; //defines the communication between MBed and pc
aidanPJG 26:4289549b2d21 9 int NoOfPins = 6; //for how many sensors there are
aidanPJG 31:bea1117f14fb 10 DigitalIn sensor[6] = {p5,p6,p7,p8,p9,p10} ; //array of sensors.
aidanPJG 31:bea1117f14fb 11
aidanPJG 31:bea1117f14fb 12
aidanPJG 19:a3edf2c547e1 13 //c++ variables
aidanPJG 26:4289549b2d21 14 time_t sensor_time ; //time at which sensor is broken
aidanPJG 32:792c4239a738 15 int timeDiff; //time between 2 sensors - not used right now
aidanPJG 31:bea1117f14fb 16 int times[6]; //array the size of #pins
aidanPJG 33:929f1755664b 17 float speed;
aidanPJG 26:4289549b2d21 18
aidanPJG 33:929f1755664b 19 int calculate(float distance)
aidanPJG 22:34bc2f2f5b09 20 {
aidanPJG 22:34bc2f2f5b09 21 pc.printf("new program \n"); //alert user of initialisation
aidanPJG 22:34bc2f2f5b09 22
aidanPJG 30:ab3a436e8968 23 int i = 0;
aidanPJG 30:ab3a436e8968 24 while( i < 6)
aidanPJG 25:bab86a12e9ad 25 {
aidanPJG 30:ab3a436e8968 26 while(!sensor[i])
aidanPJG 22:34bc2f2f5b09 27 {
aidanPJG 30:ab3a436e8968 28 if(sensor[i + 1]) {
aidanPJG 30:ab3a436e8968 29 sensor_time = time(NULL);
aidanPJG 30:ab3a436e8968 30 i++;
aidanPJG 30:ab3a436e8968 31 } //error checking incase next one is done
aidanPJG 22:34bc2f2f5b09 32 }
aidanPJG 33:929f1755664b 33 sensor_time = time(NULL); //gets current time
aidanPJG 32:792c4239a738 34 pc.printf(" %dth sensor: %d \t", i,sensor_time);
aidanPJG 33:929f1755664b 35 pc.printf(" distance is: %f \t", distance);
aidanPJG 31:bea1117f14fb 36 times[i] = sensor_time; //adds sensor times to array for logging.
aidanPJG 33:929f1755664b 37 if ( i > 0) { //to ensure it is not the first one
aidanPJG 33:929f1755664b 38 timeDiff = difftime(times[i], times[i-1]); //calculates the time difference
aidanPJG 33:929f1755664b 39 pc.printf(" timediff: %d \t", timeDiff);
aidanPJG 33:929f1755664b 40 speed = distance / timeDiff;
aidanPJG 33:929f1755664b 41 pc.printf(" speed : %f \t", speed);
aidanPJG 32:792c4239a738 42 }
aidanPJG 30:ab3a436e8968 43 i++;
aidanPJG 30:ab3a436e8968 44 }
aidanPJG 32:792c4239a738 45 pc.printf(" \n Calculate completed \n"); //alert to let user know it completed
aidanPJG 32:792c4239a738 46 for (int i = 0; i < 5 ; i++) //printing module for array
aidanPJG 31:bea1117f14fb 47 {
aidanPJG 32:792c4239a738 48 pc.printf(" times: %d \t", times[i]);
aidanPJG 31:bea1117f14fb 49 }
aidanPJG 25:bab86a12e9ad 50
aidanPJG 22:34bc2f2f5b09 51 }
aidanPJG 30:ab3a436e8968 52
aidanPJG 30:ab3a436e8968 53