![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
.
trasmit.cpp@0:91eadeaa067b, 2019-12-27 (annotated)
- Committer:
- drorbalbul
- Date:
- Fri Dec 27 18:06:43 2019 +0000
- Revision:
- 0:91eadeaa067b
.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
drorbalbul | 0:91eadeaa067b | 1 | #include "mbed.h" |
drorbalbul | 0:91eadeaa067b | 2 | #include <Map.hpp> |
drorbalbul | 0:91eadeaa067b | 3 | #define ConvertToVolt 3300; |
drorbalbul | 0:91eadeaa067b | 4 | #define Sum 3300; |
drorbalbul | 0:91eadeaa067b | 5 | //#define ConvertToDagree (1800/7); |
drorbalbul | 0:91eadeaa067b | 6 | |
drorbalbul | 0:91eadeaa067b | 7 | AnalogIn analog_value1(PA_3); |
drorbalbul | 0:91eadeaa067b | 8 | AnalogIn analog_value2(PA_4); |
drorbalbul | 0:91eadeaa067b | 9 | Serial pc(USBTX,USBRX); |
drorbalbul | 0:91eadeaa067b | 10 | //Ticker ticker; |
drorbalbul | 0:91eadeaa067b | 11 | CAN can1(PA_11, PA_12); |
drorbalbul | 0:91eadeaa067b | 12 | int matzeret = 0; |
drorbalbul | 0:91eadeaa067b | 13 | char matzeretc = 0; |
drorbalbul | 0:91eadeaa067b | 14 | |
drorbalbul | 0:91eadeaa067b | 15 | |
drorbalbul | 0:91eadeaa067b | 16 | void send() { |
drorbalbul | 0:91eadeaa067b | 17 | if(can1.write(CANMessage(1337, &matzeretc, 1))) { |
drorbalbul | 0:91eadeaa067b | 18 | pc.printf("massage sent %d", matzeretc); |
drorbalbul | 0:91eadeaa067b | 19 | } |
drorbalbul | 0:91eadeaa067b | 20 | } |
drorbalbul | 0:91eadeaa067b | 21 | |
drorbalbul | 0:91eadeaa067b | 22 | int main() { |
drorbalbul | 0:91eadeaa067b | 23 | float pedal1, pedal2, sumpedal, subpedal; |
drorbalbul | 0:91eadeaa067b | 24 | Map mapvaltovolt = Map(0, 1, 0, 3300); |
drorbalbul | 0:91eadeaa067b | 25 | Map mapvaltodagree = Map(850, 1200, 0, 90); |
drorbalbul | 0:91eadeaa067b | 26 | while(1) { |
drorbalbul | 0:91eadeaa067b | 27 | pedal1 = analog_value1.read(); |
drorbalbul | 0:91eadeaa067b | 28 | pedal2 = analog_value2.read(); |
drorbalbul | 0:91eadeaa067b | 29 | pedal1 = mapvaltovolt.Calculate(pedal1); |
drorbalbul | 0:91eadeaa067b | 30 | pedal2 = mapvaltovolt.Calculate(pedal2); |
drorbalbul | 0:91eadeaa067b | 31 | //pedal2 = pedal2 * ConvertToVolt; // Change the value to be in the 0 to 3300range*/ |
drorbalbul | 0:91eadeaa067b | 32 | |
drorbalbul | 0:91eadeaa067b | 33 | |
drorbalbul | 0:91eadeaa067b | 34 | pc.printf("pedal1 is: %.4f, pedal2 is:%.4f\n\r", pedal1, pedal2); |
drorbalbul | 0:91eadeaa067b | 35 | sumpedal = pedal1+pedal2; |
drorbalbul | 0:91eadeaa067b | 36 | //pc.printf("sumpedal is: %.4f\n\r", sumpedal); |
drorbalbul | 0:91eadeaa067b | 37 | subpedal = abs(3500-sumpedal); |
drorbalbul | 0:91eadeaa067b | 38 | //pc.printf("Subpedal is: %.4f\n\r", subpedal); |
drorbalbul | 0:91eadeaa067b | 39 | //if (subpedal<175) { |
drorbalbul | 0:91eadeaa067b | 40 | matzeret = mapvaltodagree.Calculate(pedal1); |
drorbalbul | 0:91eadeaa067b | 41 | pc.printf("dagree %d\n\r", matzeret); |
drorbalbul | 0:91eadeaa067b | 42 | //matzeret = (matzeret - (1530/7))/10000; |
drorbalbul | 0:91eadeaa067b | 43 | matzeretc = matzeret; |
drorbalbul | 0:91eadeaa067b | 44 | send(); |
drorbalbul | 0:91eadeaa067b | 45 | //} |
drorbalbul | 0:91eadeaa067b | 46 | /*else{ |
drorbalbul | 0:91eadeaa067b | 47 | pc.printf("error\n\r"); |
drorbalbul | 0:91eadeaa067b | 48 | }*/ |
drorbalbul | 0:91eadeaa067b | 49 | wait(1); |
drorbalbul | 0:91eadeaa067b | 50 | //ticker.attach(&send, 1); |
drorbalbul | 0:91eadeaa067b | 51 | } |
drorbalbul | 0:91eadeaa067b | 52 | } |