test
Dependents: MouseHybridSenseCode
main.cpp@3:7f44ab64e96b, 2018-03-05 (annotated)
- Committer:
- JamieBignell
- Date:
- Mon Mar 05 22:40:25 2018 +0000
- Revision:
- 3:7f44ab64e96b
- Parent:
- 0:c0c329729a7a
- Child:
- 4:f1670eec4681
final before code actually downloaded
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
JamieBignell | 0:c0c329729a7a | 1 | #include "mbed.h" |
JamieBignell | 0:c0c329729a7a | 2 | #include "funcdef.h" |
JamieBignell | 0:c0c329729a7a | 3 | |
JamieBignell | 3:7f44ab64e96b | 4 | int main() |
JamieBignell | 3:7f44ab64e96b | 5 | { |
JamieBignell | 3:7f44ab64e96b | 6 | //runs code once |
JamieBignell | 3:7f44ab64e96b | 7 | while (1) |
JamieBignell | 3:7f44ab64e96b | 8 | { |
JamieBignell | 3:7f44ab64e96b | 9 | static bool initialized=false; |
JamieBignell | 3:7f44ab64e96b | 10 | if (!initialized) |
JamieBignell | 3:7f44ab64e96b | 11 | { |
JamieBignell | 3:7f44ab64e96b | 12 | initialized = true; |
JamieBignell | 3:7f44ab64e96b | 13 | leftMotorVal.period_ms(10); |
JamieBignell | 3:7f44ab64e96b | 14 | for (int i=1; i <=5; i++) |
JamieBignell | 3:7f44ab64e96b | 15 | { |
JamieBignell | 3:7f44ab64e96b | 16 | LEDVal =1; |
JamieBignell | 3:7f44ab64e96b | 17 | wait(0.5); |
JamieBignell | 3:7f44ab64e96b | 18 | LEDVal =0; |
JamieBignell | 3:7f44ab64e96b | 19 | wait(0.5); |
JamieBignell | 3:7f44ab64e96b | 20 | } |
JamieBignell | 3:7f44ab64e96b | 21 | leftMotorVal.period_us(1023); |
JamieBignell | 3:7f44ab64e96b | 22 | rightMotorVal.period_us(1023); |
JamieBignell | 3:7f44ab64e96b | 23 | /* |
JamieBignell | 3:7f44ab64e96b | 24 | for (int i=0;i<=7;i++) |
JamieBignell | 3:7f44ab64e96b | 25 | { |
JamieBignell | 3:7f44ab64e96b | 26 | sensorValue[i]=((sensorPin[i]).read_u16()>>4); |
JamieBignell | 3:7f44ab64e96b | 27 | sensorMinValue[i]=sensorValue[i]; |
JamieBignell | 3:7f44ab64e96b | 28 | sensorMaxValue[i]=sensorValue[i]; |
JamieBignell | 3:7f44ab64e96b | 29 | } |
JamieBignell | 3:7f44ab64e96b | 30 | */ |
JamieBignell | 3:7f44ab64e96b | 31 | |
JamieBignell | 3:7f44ab64e96b | 32 | } |
JamieBignell | 3:7f44ab64e96b | 33 | /* |
JamieBignell | 3:7f44ab64e96b | 34 | int doneYet=0; |
JamieBignell | 3:7f44ab64e96b | 35 | while(1) |
JamieBignell | 3:7f44ab64e96b | 36 | { |
JamieBignell | 3:7f44ab64e96b | 37 | for (int i=0;i<=7;i++) |
JamieBignell | 3:7f44ab64e96b | 38 | { |
JamieBignell | 3:7f44ab64e96b | 39 | sensorValue[i]=((sensorPin[i]).read_u16()>>4); |
JamieBignell | 3:7f44ab64e96b | 40 | if (sensorValue[i]>=sensorMaxValue[i]) |
JamieBignell | 3:7f44ab64e96b | 41 | { |
JamieBignell | 3:7f44ab64e96b | 42 | sensorMaxValue[i]=sensorValue[i]; |
JamieBignell | 3:7f44ab64e96b | 43 | } |
JamieBignell | 3:7f44ab64e96b | 44 | else if ((sensorValue[i]+25)<=sensorMaxValue[i]) |
JamieBignell | 3:7f44ab64e96b | 45 | { |
JamieBignell | 3:7f44ab64e96b | 46 | doneYet++; |
JamieBignell | 3:7f44ab64e96b | 47 | if (doneYet==8) |
JamieBignell | 3:7f44ab64e96b | 48 | { |
JamieBignell | 3:7f44ab64e96b | 49 | break; |
JamieBignell | 3:7f44ab64e96b | 50 | } |
JamieBignell | 3:7f44ab64e96b | 51 | } |
JamieBignell | 3:7f44ab64e96b | 52 | wait_ms(5); |
JamieBignell | 3:7f44ab64e96b | 53 | } |
JamieBignell | 3:7f44ab64e96b | 54 | } |
JamieBignell | 3:7f44ab64e96b | 55 | */ |
JamieBignell | 3:7f44ab64e96b | 56 | for (int i=0;i<=7;i++) |
JamieBignell | 3:7f44ab64e96b | 57 | { |
JamieBignell | 3:7f44ab64e96b | 58 | sensorValue[i]=((sensorPin[i]).read_u16()>>4); |
JamieBignell | 3:7f44ab64e96b | 59 | } |
JamieBignell | 3:7f44ab64e96b | 60 | CalibrateFunc(); |
JamieBignell | 3:7f44ab64e96b | 61 | //set baud rate 9600 |
JamieBignell | 3:7f44ab64e96b | 62 | pc.printf("$%d %d %d ;", (sensorValue[0]),(sensorValue[1]),(sensorValue[2])); |
JamieBignell | 3:7f44ab64e96b | 63 | wait_ms(10); |
JamieBignell | 3:7f44ab64e96b | 64 | } |
JamieBignell | 3:7f44ab64e96b | 65 | |
JamieBignell | 3:7f44ab64e96b | 66 | //printf("ADC Val 1 : %d\r\n",(); |
JamieBignell | 3:7f44ab64e96b | 67 | return 0; |
JamieBignell | 3:7f44ab64e96b | 68 | } |