123 lines
4.7 KiB
C++
123 lines
4.7 KiB
C++
/*
|
|
Speeduino - Simple engine management for the Arduino Mega 2560 platform
|
|
Copyright (C) Josh Stewart
|
|
A full copy of the license may be found in the projects root directory
|
|
*/
|
|
|
|
/*
|
|
This is for handling the data broadcasted to various CAN dashes and instrument clusters.
|
|
*/
|
|
#include "globals.h"
|
|
#if defined(NATIVE_CAN_AVAILABLE)
|
|
#include "canBroadcast.h"
|
|
|
|
// Forward declare
|
|
void DashMessage(uint16_t DashMessageID);
|
|
|
|
void sendBMWCluster()
|
|
{
|
|
DashMessage(CAN_BMW_DME1);
|
|
Can0.write(outMsg);
|
|
DashMessage(CAN_BMW_DME2);
|
|
Can0.write(outMsg);
|
|
DashMessage(CAN_BMW_DME4);
|
|
Can0.write(outMsg);
|
|
}
|
|
|
|
void sendVAGCluster()
|
|
{
|
|
DashMessage(CAN_VAG_RPM);
|
|
Can0.write(outMsg);
|
|
DashMessage(CAN_VAG_VSS);
|
|
Can0.write(outMsg);
|
|
}
|
|
|
|
// switch case for gathering all data to message based on CAN Id.
|
|
void DashMessage(uint16_t DashMessageID)
|
|
{
|
|
switch (DashMessageID)
|
|
{
|
|
case CAN_BMW_DME1:
|
|
uint32_t temp_RPM;
|
|
temp_RPM = currentStatus.RPM * 64; //RPM conversion is currentStatus.RPM * 6.4, but this does it without floats.
|
|
temp_RPM = temp_RPM / 10;
|
|
outMsg.id = DashMessageID;
|
|
outMsg.len = 8;
|
|
outMsg.buf[0] = 0x05; //bitfield, Bit0 = 1 = terminal 15 on detected, Bit2 = 1 = the ASC message ASC1 was received within the last 500 ms and contains no plausibility errors
|
|
outMsg.buf[1] = 0x0C; //Indexed Engine Torque in % of C_TQ_STND TBD do torque calculation.
|
|
outMsg.buf[2] = lowByte(uint16_t(temp_RPM)); //lsb RPM
|
|
outMsg.buf[3] = highByte(uint16_t(temp_RPM)); //msb RPM
|
|
outMsg.buf[4] = 0x0C; //Indicated Engine Torque in % of C_TQ_STND TBD do torque calculation!! Use same as for byte 1
|
|
outMsg.buf[5] = 0x15; //Engine Torque Loss (due to engine friction, AC compressor and electrical power consumption)
|
|
outMsg.buf[6] = 0x00; //not used
|
|
outMsg.buf[7] = 0x35; //Theorethical Engine Torque in % of C_TQ_STND after charge intervention
|
|
break;
|
|
|
|
case CAN_BMW_DME2:
|
|
uint8_t temp_TPS;
|
|
uint8_t temp_BARO;
|
|
uint16_t temp_CLT;
|
|
temp_TPS = map(currentStatus.TPS, 0, 100, 0, 254);//TPS value conversion (from 0x00 to 0xFE)
|
|
temp_CLT = (((currentStatus.coolant - CALIBRATION_TEMPERATURE_OFFSET) + 48)*4/3); //CLT conversion (actual value to add is 48.373, but close enough)
|
|
if (temp_CLT > 255) { temp_CLT = 255; } //CLT conversion can yield to higher values than what fits to byte, so limit the maximum value to 255.
|
|
temp_BARO = currentStatus.baro;
|
|
|
|
outMsg.id = DashMessageID;
|
|
outMsg.len = 7;
|
|
outMsg.buf[0] = 0x11; //Multiplexed Information
|
|
outMsg.buf[1] = temp_CLT;
|
|
outMsg.buf[2] = temp_BARO;
|
|
outMsg.buf[3] = 0x08; //bitfield, Bit0 = 0 = Clutch released, Bit 3 = 1 = engine running
|
|
outMsg.buf[4] = 0x00; //TPS_VIRT_CRU_CAN (Not used)
|
|
outMsg.buf[5] = temp_TPS;
|
|
outMsg.buf[6] = 0x00; //bitfield, Bit0 = 0 = brake not actuated, Bit1 = 0 = brake switch system OK etc...
|
|
outMsg.buf[7] = 0x00; //not used, but set to zero just in case.
|
|
break;
|
|
|
|
case 0x545: //fuel consumption and CEl light for BMW e46/e39/e38 instrument cluster
|
|
//fuel consumption calculation not implemented yet. But this still needs to be sent to get rid of the CEL and EML fault lights on the dash.
|
|
outMsg.id = DashMessageID;
|
|
outMsg.len = 5;
|
|
outMsg.buf[0] = 0x00; //Check engine light (binary 10), Cruise light (binary 1000), EML (binary 10000).
|
|
outMsg.buf[1] = 0x00; //LSB Fuel consumption
|
|
outMsg.buf[2] = 0x00; //MSB Fuel Consumption
|
|
if (currentStatus.coolant > 159) { outMsg.buf[3] = 0x08; } //Turn on overheat light if coolant temp hits 120 degrees celsius.
|
|
else { outMsg.buf[3] = 0x00; } //Overheat light off at normal engine temps.
|
|
outMsg.buf[4] = 0x7E; //this is oil temp
|
|
break;
|
|
|
|
case 0x280: //RPM for VW instrument cluster
|
|
temp_RPM = currentStatus.RPM * 4; //RPM conversion
|
|
outMsg.id = DashMessageID;
|
|
outMsg.len = 8;
|
|
outMsg.buf[0] = 0x49;
|
|
outMsg.buf[1] = 0x0E;
|
|
outMsg.buf[2] = lowByte(uint16_t(temp_RPM)); //lsb RPM
|
|
outMsg.buf[3] = highByte(uint16_t(temp_RPM)); //msb RPM
|
|
outMsg.buf[4] = 0x0E;
|
|
outMsg.buf[5] = 0x00;
|
|
outMsg.buf[6] = 0x1B;
|
|
outMsg.buf[7] = 0x0E;
|
|
break;
|
|
|
|
case 0x5A0: //VSS for VW instrument cluster
|
|
uint16_t temp_VSS;
|
|
temp_VSS = currentStatus.vss * 133; //VSS conversion
|
|
outMsg.id = DashMessageID;
|
|
outMsg.len = 8;
|
|
outMsg.buf[0] = 0xFF;
|
|
outMsg.buf[1] = lowByte(temp_VSS);
|
|
outMsg.buf[2] = highByte(temp_VSS);
|
|
outMsg.buf[3] = 0x00;
|
|
outMsg.buf[4] = 0x00;
|
|
outMsg.buf[5] = 0x00;
|
|
outMsg.buf[6] = 0x00;
|
|
outMsg.buf[7] = 0xAD;
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
#endif
|