.

Dependencies:   mbed cantran

Committer:
drorbalbul
Date:
Fri Dec 27 18:06:43 2019 +0000
Revision:
0:91eadeaa067b
.

Who changed what in which revision?

UserRevisionLine numberNew 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 }