Mark Bruijn / Mbed 2 deprecated SOS_V1

new battery bar

Dependencies:   CAN_IDs CanControl Dashboard PinDetect PowerControl mbed-rtos mbed

main.cpp@16:c5427db9edf0, 2017-05-22 (annotated)

Committer:
zathorix
Date:
Mon May 22 18:12:08 2017 +0000
Revision:
16:c5427db9edf0
Parent:
15:56b25cffa523
Child:
17:91ba27c14991
Deprecated bms reader in main, implemented data acquisition

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kwasymodo 1:c5d8ea5d049b 1 /*******************************************************************************
kwasymodo 4:dfd10f43cc8b 2 This software is especially designed for Solarboat Twente for the use in their Solarboat v1.0
kwasymodo 1:c5d8ea5d049b 3
kwasymodo 1:c5d8ea5d049b 4 Written by:
kwasymodo 1:c5d8ea5d049b 5 Niels Leijen, Jesse van Rhijn, Bram Seinhorst
kwasymodo 1:c5d8ea5d049b 6
kwasymodo 1:c5d8ea5d049b 7 Thanks to:
kwasymodo 1:c5d8ea5d049b 8 Jasper Admiraal, Hidde Pik (hihihihi), Lisa Postma, Heleen Jeurink, Ruben Peters,
kwasymodo 1:c5d8ea5d049b 9 Martijn Groot Jebbink, Martijn Wilpshaar, Bram Seinhorst, Robert Geels, Arnoud Meutstege,
kwasymodo 4:dfd10f43cc8b 10 Jeroen te Braake, Ids de Vos, Jesse van Rhijn, Sam Benou, Niels Leijen and Mark Bruijn
kwasymodo 1:c5d8ea5d049b 11
kwasymodo 1:c5d8ea5d049b 12 DISCLAIMER:
kwasymodo 1:c5d8ea5d049b 13 THIS SOFTWARE IS SUPPLIED "AS IS" WITHOUT ANY WARRANTIES AND SUPPORT.
kwasymodo 1:c5d8ea5d049b 14 SOLARBOATTWENTE ASSUMES NO RESPONSIBILITY OR LIABILITY FOR THE USE OF THE SOFTWARE.
kwasymodo 1:c5d8ea5d049b 15 *******************************************************************************/
kwasymodo 1:c5d8ea5d049b 16
kwasymodo 1:c5d8ea5d049b 17 // uncomment to send debug information
kwasymodo 1:c5d8ea5d049b 18 #define DEBUG
kwasymodo 1:c5d8ea5d049b 19
kwasymodo 1:c5d8ea5d049b 20 //include 3rd party libraries
kwasymodo 4:dfd10f43cc8b 21 #include "mbed.h" //needs to be revision 136 else SD filesystem will not work
kwasymodo 1:c5d8ea5d049b 22 #include "rtos.h"
kwasymodo 1:c5d8ea5d049b 23
kwasymodo 1:c5d8ea5d049b 24 // include Solarboat libraries
kwasymodo 1:c5d8ea5d049b 25 #include "pinout.h"
zathorix 14:0ad1bc8be76b 26 #include "CAN_IDs.h"
kwasymodo 1:c5d8ea5d049b 27 #include "PowerControl.h"
zathorix 16:c5427db9edf0 28 #include "TelemetryAndDaq.h"
zathorix 16:c5427db9edf0 29 #include "Dashboard.h"
kwasymodo 1:c5d8ea5d049b 30
zathorix 15:56b25cffa523 31 #define SPEED_THRESH 0.02 //threshold for setting speed to prevent CAN spam
zathorix 14:0ad1bc8be76b 32
kwasymodo 1:c5d8ea5d049b 33 // initialize serial connection for debug
kwasymodo 1:c5d8ea5d049b 34 #ifdef DEBUG
kwasymodo 3:b164662f9740 35 RawSerial pc(SERIAL_TX, SERIAL_RX);
kwasymodo 1:c5d8ea5d049b 36 #endif
kwasymodo 1:c5d8ea5d049b 37
kwasymodo 1:c5d8ea5d049b 38 // initialize canbus
kwasymodo 1:c5d8ea5d049b 39 CAN can(CAN_RD, CAN_TD);
kwasymodo 1:c5d8ea5d049b 40
zathorix 14:0ad1bc8be76b 41 //init throttle
zathorix 14:0ad1bc8be76b 42 AnalogIn analogThrottle(STEER_THROTTLE);
zathorix 14:0ad1bc8be76b 43
kwasymodo 1:c5d8ea5d049b 44 // initialze onboard leds
kwasymodo 1:c5d8ea5d049b 45 DigitalOut ledError(LED3);
kwasymodo 1:c5d8ea5d049b 46 DigitalOut ledSD(LED1);
kwasymodo 1:c5d8ea5d049b 47 DigitalOut ledFona(LED5);
kwasymodo 1:c5d8ea5d049b 48 DigitalOut led24V(LED4);
kwasymodo 1:c5d8ea5d049b 49
kwasymodo 11:005a50dd7db5 50 DigitalOut buckXSens(BUCK3);
kwasymodo 11:005a50dd7db5 51 DigitalOut buckScreen(BUCK4);
kwasymodo 11:005a50dd7db5 52 DigitalOut buck24V(BUCK5);
kwasymodo 1:c5d8ea5d049b 53
zathorix 16:c5427db9edf0 54 //external classes
zathorix 16:c5427db9edf0 55 extern DataAcquisition daq;
kwasymodo 1:c5d8ea5d049b 56
zathorix 16:c5427db9edf0 57 //external variables
zathorix 16:c5427db9edf0 58 extern long long int starttime;
kwasymodo 11:005a50dd7db5 59
zathorix 16:c5427db9edf0 60 //external threads
zathorix 16:c5427db9edf0 61 extern Thread threadbg;
kwasymodo 1:c5d8ea5d049b 62
zathorix 15:56b25cffa523 63 //global var for speed; ugly solution but works
zathorix 14:0ad1bc8be76b 64 float speed = 0;
zathorix 14:0ad1bc8be76b 65
zathorix 16:c5427db9edf0 66 //thread function declarations
zathorix 16:c5427db9edf0 67 void readThrottle();
zathorix 16:c5427db9edf0 68 void power();
zathorix 16:c5427db9edf0 69 void test();
zathorix 16:c5427db9edf0 70 void background();
zathorix 14:0ad1bc8be76b 71
kwasymodo 1:c5d8ea5d049b 72 // Thread 0 - DO NOT CHANGE THIS!
kwasymodo 1:c5d8ea5d049b 73 int main() {
kwasymodo 1:c5d8ea5d049b 74 #ifdef DEBUG
kwasymodo 1:c5d8ea5d049b 75 pc.baud(115200);
kwasymodo 3:b164662f9740 76 pc.printf("Starting SOS V1.0\n");
kwasymodo 1:c5d8ea5d049b 77 #endif
kwasymodo 1:c5d8ea5d049b 78 // change CAN frequency
kwasymodo 1:c5d8ea5d049b 79 can.frequency(250000);
kwasymodo 1:c5d8ea5d049b 80
kwasymodo 1:c5d8ea5d049b 81 // initialze threads
zathorix 15:56b25cffa523 82 Thread threadpower;
zathorix 15:56b25cffa523 83 Thread threadtest;
zathorix 14:0ad1bc8be76b 84 Thread threadthrottle;
kwasymodo 1:c5d8ea5d049b 85
kwasymodo 1:c5d8ea5d049b 86 // start threads
zathorix 15:56b25cffa523 87 threadpower.start(&power);
zathorix 16:c5427db9edf0 88 threadbg.start(&background);
zathorix 15:56b25cffa523 89 threadtest.start(&test);
zathorix 14:0ad1bc8be76b 90 threadthrottle.start(&readThrottle);
kwasymodo 1:c5d8ea5d049b 91
zathorix 16:c5427db9edf0 92 daq.enable(starttime);
zathorix 16:c5427db9edf0 93
zathorix 16:c5427db9edf0 94 //BMS message parser, now imlpemented in DAQ lib
zathorix 16:c5427db9edf0 95 /*CANMessage msg;
kwasymodo 11:005a50dd7db5 96 while(1) {
kwasymodo 11:005a50dd7db5 97 if(can.read(msg)) {
kwasymodo 11:005a50dd7db5 98 pc.printf("Message received: 0x %x; %u %u%u %d%d %c %u %u\n", msg.id, msg.data[0], msg.data[1], msg.data[2], msg.data[3], msg.data[4], msg.data[5], msg.data[6], msg.data[7]);
zathorix 16:c5427db9edf0 99 }
zathorix 16:c5427db9edf0 100 Thread::wait(10);
zathorix 16:c5427db9edf0 101 }*/
zathorix 16:c5427db9edf0 102 Thread::wait(osWaitForever);
zathorix 16:c5427db9edf0 103 }
zathorix 16:c5427db9edf0 104
zathorix 16:c5427db9edf0 105 //send motor command
zathorix 16:c5427db9edf0 106 void sendMotorSpeed(float throttle) {
zathorix 16:c5427db9edf0 107 if ((abs(throttle - speed)) > SPEED_THRESH) {
zathorix 16:c5427db9edf0 108 union {
zathorix 16:c5427db9edf0 109 char msg[4];
zathorix 16:c5427db9edf0 110 float value;
zathorix 16:c5427db9edf0 111 } packet;
zathorix 16:c5427db9edf0 112 packet.value = throttle;
zathorix 16:c5427db9edf0 113 can.write(CANMessage(MOTOR_COMMAND, packet.msg));
zathorix 16:c5427db9edf0 114 printf("Sent motor speed: %f\r\n", packet.value);
zathorix 16:c5427db9edf0 115 speed = throttle;
kwasymodo 11:005a50dd7db5 116 }
zathorix 16:c5427db9edf0 117 }
zathorix 16:c5427db9edf0 118
zathorix 16:c5427db9edf0 119 //thread functions
zathorix 16:c5427db9edf0 120 void readThrottle() {
zathorix 16:c5427db9edf0 121 float throttleread;
zathorix 16:c5427db9edf0 122 while(1) {
zathorix 16:c5427db9edf0 123 throttleread = 2*(0.5 - analogThrottle.read());
zathorix 16:c5427db9edf0 124 sendMotorSpeed(throttleread);
zathorix 16:c5427db9edf0 125 Thread::wait(10);
zathorix 16:c5427db9edf0 126 }
zathorix 16:c5427db9edf0 127 }
zathorix 16:c5427db9edf0 128
zathorix 16:c5427db9edf0 129
zathorix 16:c5427db9edf0 130
zathorix 16:c5427db9edf0 131 void power() {
zathorix 16:c5427db9edf0 132 PowerControl powercontrol(PUSH_GREEN);
zathorix 16:c5427db9edf0 133
zathorix 16:c5427db9edf0 134 #ifdef DEBUG
zathorix 16:c5427db9edf0 135 pc.printf("Thread 1 - Power started\r\n ");
zathorix 16:c5427db9edf0 136 #endif
zathorix 16:c5427db9edf0 137
kwasymodo 1:c5d8ea5d049b 138 Thread::wait(osWaitForever);
zathorix 16:c5427db9edf0 139 }
zathorix 16:c5427db9edf0 140
zathorix 16:c5427db9edf0 141 void test() {
zathorix 16:c5427db9edf0 142 ledError = 0;
zathorix 16:c5427db9edf0 143 ledSD = 0;
zathorix 16:c5427db9edf0 144 ledFona = 0 ;
zathorix 16:c5427db9edf0 145 led24V=1;
zathorix 16:c5427db9edf0 146
zathorix 16:c5427db9edf0 147 //DigitalOut buckCan(BUCK2);
zathorix 16:c5427db9edf0 148 buckXSens = 0;
zathorix 16:c5427db9edf0 149 buckScreen = 0;
zathorix 16:c5427db9edf0 150 buck24V = 1;
zathorix 16:c5427db9edf0 151 }