Diff: CANParserCharger.cpp

Revision:

1:0c77e20b4d4c

Child:

3:a7626dffb64a

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/CANParserCharger.cpp	Thu Jul 06 21:27:26 2017 +0000
@@ -0,0 +1,85 @@
+// Here are the functions to generate the CAN messages
+#include "CANParserCharger.h"
+#include "mbed.h"
+#include "CAN_IDs.h"
+
+
+using namespace CAN_IDs;
+
+
+
+
+
+void get_charger_control_info(CANMessage msg, float &_voltage_error, float &_temp_margin, float &_discharge_error, float &_pack_capacity) {
+    CAN_Data data;
+    data.importCANData(msg);
+    
+    _voltage_error = data.get_u16(0)*1.0;
+    _temp_margin = data.get_u16(1) /10.0;
+    _discharge_error = data.get_u16(2)*1.0;
+    _pack_capacity = data.get_u16(3)*1.0;
+}
+
+void get_max_min_voltage(CANMessage msg, float &_min_cell_voltage, float &_max_cell_voltage) {
+    CAN_Data data;
+    data.importCANData(msg);
+    
+    _min_cell_voltage = data.get_u16(0)*1.0;
+    _max_cell_voltage = data.get_u16(1)*1.0;
+}    
+
+void get_battery_status(CANMessage msg, bool &error) { //note using extended battery pack status
+    CAN_Data data;
+    data.importCANData(msg);
+    
+    error = data.getLower_uLong() > 0;
+    //ignore the rest of the status as we don't care
+}
+
+void get_charger_VI_info(CANMessage msg, float &_charger_voltage, float &_charger_current, uint8_t &_charger_status) {
+    CAN_Data data;
+    data.importCANData(msg);
+    
+    _charger_voltage = data.get_u16(0)*100.0;
+    _charger_current = data.get_u16(1)*100.0;
+    _charger_status = data.get_u8(4);
+}
+
+CANMessage generate_charger_control_msg(float _desired_voltage, float _desired_current, uint8_t _charger_control) {
+    CANMessage msg;
+    msg.format = CANExtended; //the charger uses the extended CAN frame format
+    msg.len = 8;
+    msg.id = CHARGER_VI_CONTROL_ID;
+    CAN_Data data;
+    data.set_u16(0, (uint16_t) (_desired_voltage/100));
+    data.set_u16(1, (uint16_t) (_desired_current/100));
+    data.set_u8(4, _charger_control);
+    data.set_u8(5,0);
+    data.set_u8(6,0);
+    data.set_u8(7,0);
+    
+    for(int i=0; i<8; i++) {
+        msg.data[i] = data.get_u8(i);
+    }
+    
+    return msg;
+}
+
+CANMessage generate_charger_info_msg(float _charger_voltage, float _charger_current, uint8_t _charger_status) {
+    CANMessage msg;
+    msg.len = 8;
+    msg.id = CHARGER_ID;
+    CAN_Data data;
+    data.set_u16(0, (uint16_t) (_charger_voltage/100));
+    data.set_u16(1, (uint16_t) (_charger_current/100));
+    data.set_u8(4, _charger_status);
+    data.set_u8(5,0);
+    data.set_u8(6,0);
+    data.set_u8(7,0);
+    
+    for(int i=0; i<8; i++) {
+        msg.data[i] = data.get_u8(i);
+    }
+    
+    return msg;
+}
\ No newline at end of file