yetangitu/Battery-Emulator
1
0
Fork 0
mirror of https://github.com/dalathegreat/Battery-Emulator.git synced 2025-10-05 02:39:57 +02:00
Code Issues Projects Releases Packages Wiki Activity

Add Kostal RS485 protocol

Browse source
This commit is contained in:
Daniel Öster 2024-08-27 16:33:36 +03:00
parent c95fa88bc7
commit cbdb2392d9
6 changed files with 250 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

6
Software/Software.ino
View file

@ -209,6 +209,9 @@ void core_loop(void* task_time_us) {
#ifdef DUAL_CAN
receive_can_addonMCP2515(); // Receive CAN messages on add-on MCP2515 chip
#endif
#ifdef RS485_INVERTER_SELECTED
receive_RS485(); // Process serial2 RS485 interface
#endif
#if defined(SERIAL_LINK_RECEIVER) || defined(SERIAL_LINK_TRANSMITTER)
runSerialDataLink();
#endif
@ -768,6 +771,9 @@ void update_values_inverter() {
#ifdef MODBUS_INVERTER_SELECTED
update_modbus_registers_inverter();
#endif
#ifdef RS485_INVERTER_SELECTED
update_RS485_registers_inverter();
#endif
}
#if defined(SERIAL_LINK_RECEIVER) || defined(SERIAL_LINK_TRANSMITTER)

1
Software/USER_SETTINGS.h
View file

@ -32,6 +32,7 @@
//#define BYD_CAN //Enable this line to emulate a "BYD Battery-Box Premium HVS" over CAN Bus
//#define BYD_SMA //Enable this line to emulate a SMA compatible "BYD Battery-Box HVS 10.2KW battery" over CAN bus
//#define BYD_MODBUS //Enable this line to emulate a "BYD 11kWh HVM battery" over Modbus RTU
//#define BYD_KOSTAL_RS485 //Enable this line to emulate a "BYD 11kWh HVM battery" over Kostal RS485
//#define LUNA2000_MODBUS //Enable this line to emulate a "Luna2000 battery" over Modbus RTU
//#define PYLON_CAN //Enable this line to emulate a "Pylontech battery" over CAN bus
//#define SMA_CAN //Enable this line to emulate a "BYD Battery-Box H 8.9kWh, 7 mod" over CAN bus

7
Software/src/include.h
View file

@ -41,6 +41,13 @@
#endif
#endif
#ifdef RS485_INVERTER_SELECTED
#if defined(SERIAL_LINK_RECEIVER) || defined(SERIAL_LINK_TRANSMITTER)
// Check that Dual LilyGo via RS485 option isn't enabled, this collides with Modbus!
#error RS485 CANNOT BE USED IN DOUBLE LILYGO SETUPS! CHECK USER SETTINGS!
#endif
#endif
#ifndef BATTERY_SELECTED
#error No battery selected! Choose one from the USER_SETTINGS.h file
#endif

9
Software/src/inverter/INVERTERS.h
View file

@ -15,6 +15,10 @@
#include "BYD-SMA.h"
#endif
#ifdef BYD_KOSTAL_RS485
#include "KOSTAL-RS485.h"
#endif
#ifdef LUNA2000_MODBUS
#include "LUNA2000-MODBUS.h"
#endif
@ -53,4 +57,9 @@ void send_can_inverter();
void update_modbus_registers_inverter();
#endif
#ifdef RS485_INVERTER_SELECTED
void receive_RS485();
void update_RS485_registers_inverter();
#endif
#endif

219
Software/src/inverter/KOSTAL-RS485.cpp Normal file
View file

@ -0,0 +1,219 @@
#include "../include.h"
#ifdef BYD_KOSTAL_RS485
#include "../datalayer/datalayer.h"
#include "../devboard/utils/events.h"
#include "KOSTAL-RS485.h"
static const byte KOSTAL_FRAMEHEADER[5] = {0x62, 0xFF, 0x02, 0xFF, 0x29};
static const byte KOSTAL_FRAMEHEADER2[5] = {0x63, 0xFF, 0x02, 0xFF, 0x29};
union f32b {
float f;
byte b[4];
};
byte frame1[40] = {
0x06, 0xE2, 0xFF, 0x02, 0xFF, 0x29, 0x01, 0x08, 0x80, 0x43, // 256.063 Max Charge? first byte 0x01 or 0x04
0xE4, 0x70, 0x8A, 0x5C, 0xB5, 0x02, 0xD3, 0x01, 0x01, 0x05, 0xC8, 0x41, // 25.0024 TEMP??
0xC2, 0x18, 0x01, 0x03, 0x59, 0x42, 0x01, 0x01, 0x01, 0x02, 0x05, 0x02, 0xA0, 0x01, 0x01, 0x02, 0x4D, 0x00};
//
// values will be overwritten at update_modbus_registers_inverter()
//
byte frame2[64] = {0x0A, 0xE2, 0xFF, 0x02, 0xFF, 0x29, // frame Header
0x1D, 0x5A, 0x85, 0x43, // Voltage (float) Modbus register 216
0x01, 0x03, 0x8D, 0x43, // Max Voltage (2 byte float)
0x01, 0x03, 0xAC, 0x41, // Temp (2 byte float) Modbus register 214
0x01, 0x01, 0x01, 0x01, // Current
0x01, 0x01, 0x01, 0x01, // Current
0x01, 0x03, 0x48, 0x42, // Peak discharge current (2 byte float)
0x01, 0x03, 0xC8, 0x41, // Nominal discharge I (2 byte float)
0x01, 0x01, // Unknown
0x01, 0x05, // Max charge? (2 byte float)
0xCD, 0xCC, // Unknown
0xB4, 0x41, // MaxCellTemp (2 byte float)
0x01, 0x0C, // Maybe cell information?
0xA4, 0x41, // MinCellTemp (2 byte float)
0xA4, 0x70, 0x55, 0x40, // MaxCellVolt (float)
0x7D, 0x3F, 0x55, 0x40, // MinCellVolt (float)
0xFE, // Cylce count
0x04, // Cycle count?
0x01, 0x40, // ??
0x64, // SOC
0x01, // Unknown, Mostly 0x01, seen also 0x02
0x01, // Unknown, Seen only 0x01
0x02, // Unknown, Mostly 0x02. seen also 0x01
0x00, // CRC (inverted sum of bytes 1-62 + 0xC0)
0x00};
byte frame3[9] = {
0x08, 0xE2, 0xFF, 0x02, 0xFF, 0x29, //header
0x06, //Unknown
0xEF, //CRC
0x00 //endbyte
};
byte frameB1[10] = {0x07, 0x63, 0xFF, 0x02, 0xFF, 0x29, 0x5E, 0x02, 0x16, 0x00};
byte frameB1b[10] = {0x07, 0xE3, 0xFF, 0x02, 0xFF, 0x29, 0xF4, 0x00};
byte RS485_RXFRAME[10];
size_t RS485_RECEIVEDBYTES;
boolean reg_data_ok = false;
void float2frame(byte* arr, float value, byte framepointer) {
f32b g;
g.f = value;
arr[framepointer] = g.b[0];
arr[framepointer + 1] = g.b[1];
arr[framepointer + 2] = g.b[2];
arr[framepointer + 3] = g.b[3];
}
void float2frameMSB(byte* arr, float value, byte framepointer) {
f32b g;
g.f = value;
arr[framepointer + 0] = g.b[2];
arr[framepointer + 1] = g.b[3];
}
void send_kostal(byte* arr, int alen) {
#ifdef DEBUG_KOSTAL_RS485_DATA
Serial.print("TX: ");
for (int i = 0; i < alen; i++) {
if (arr[i] < 0x10) {
Serial.print("0")
}
Serial.print(arr[i], HEX);
Serial.print(" ");
}
Serial.println("\n");
#endif
Serial2.write(arr, alen);
}
byte calculate_longframe_crc(byte* lfc, int lastbyte) {
unsigned int sum = 0;
for (int i = 0; i < lastbyte; ++i) {
sum += lfc[i];
}
return ((byte) ~(sum + 0xc0) & 0xff);
}
boolean check_kostal_frame_crc() {
unsigned int sum = 0;
for (int i = 1; i < 8; ++i) {
sum += RS485_RXFRAME[i];
}
if (((~sum + 1) & 0xff) == (RS485_RXFRAME[8] & 0xff)) {
return (true);
} else {
return (false);
}
}
byte rx_index = 0;
void receive_RS485() // Runs as fast as possible to handle the serial stream
{
if (Serial2.available()) {
RS485_RXFRAME[rx_index] = Serial2.read();
rx_index++;
if (RS485_RXFRAME[rx_index - 1] == 0x00) //
{
if ((rx_index == 10) && (RS485_RXFRAME[0] == 0x09) && reg_data_ok) {
#ifdef DEBUG_KOSTAL_RS485_DATA
Serial.print("RX: ");
for (int i = 0; i < 10; i++) {
Serial.print(RS485_RXFRAME[i], HEX);
Serial.print(" ");
}
Serial.println("");
#endif
rx_index = 0;
if (check_kostal_frame_crc()) {
boolean notheaderA = 0;
boolean notheaderB = 0;
for (int i = 0; i < 5; i++) {
if (RS485_RXFRAME[i + 1] != KOSTAL_FRAMEHEADER[i]) {
notheaderA = true;
}
if (RS485_RXFRAME[i + 1] != KOSTAL_FRAMEHEADER2[i]) {
notheaderB = true;
}
}
if (!notheaderB && (RS485_RXFRAME[6] == 0x5E) &&
(RS485_RXFRAME[7] == 0xFF)) // "frame B1", maybe reset request, seen after battery power on/partial data
{
send_kostal(frameB1, 10);
Serial2.flush();
delay(1);
send_kostal(frameB1b, 10);
}
if (!notheaderA && (RS485_RXFRAME[6] == 0x4A) && (RS485_RXFRAME[7] == 0x08)) // "frame 1"
{
send_kostal(frame1, 40);
}
if (!notheaderA && (RS485_RXFRAME[6] == 0x4A) && (RS485_RXFRAME[7] == 0x04)) // "frame 2"
{
byte tmpframe[64]; //copy values to prevent data manipulation during rewrite/crc calculation
memcpy(tmpframe, frame2, 64);
for (int i = 1; i < 63; i++) {
if (tmpframe[i] == 0x00) {
tmpframe[i] = 0x01;
}
}
tmpframe[62] = calculate_longframe_crc(tmpframe, 62);
send_kostal(tmpframe, 64);
}
if (!notheaderA && (RS485_RXFRAME[6] == 0x53) && (RS485_RXFRAME[7] == 0x03)) // "frame 3"
{
send_kostal(frame3, 9);
}
}
}
rx_index = 0;
}
if (rx_index == 10) {
rx_index = 0;
}
}
}
void update_RS485_registers_inverter() {
float2frame(frame2, (float)datalayer.battery.status.voltage_dV / 10, 6);
float2frameMSB(frame2, (float)datalayer.battery.info.max_design_voltage_dV / 10, 12);
float2frameMSB(
frame2, (float)(datalayer.battery.status.temperature_max_dC + datalayer.battery.status.temperature_min_dC) / 20,
16);
float2frameMSB(frame2, (float)datalayer.battery.status.current_dA / 10, 20);
float2frameMSB(frame2, (float)datalayer.battery.status.current_dA / 10, 24);
float2frameMSB(frame2, (float)datalayer.battery.info.max_discharge_amp_dA / 10, 28);
float2frameMSB(frame2, (float)datalayer.battery.info.max_discharge_amp_dA / 10, 32);
float2frameMSB(frame2, (float)datalayer.battery.status.temperature_max_dC / 10, 40);
float2frameMSB(frame2, (float)datalayer.battery.status.temperature_min_dC / 10, 44);
float2frame(frame2, (float)datalayer.battery.status.cell_max_voltage_mV / 1000, 46);
float2frame(frame2, (float)datalayer.battery.status.cell_min_voltage_mV / 1000, 50);
frame2[58] = (byte)datalayer.battery.status.reported_soc / 100;
reg_data_ok = true;
}
#endif

8
Software/src/inverter/KOSTAL-RS485.h Normal file
View file

@ -0,0 +1,8 @@
#ifndef BYD_KOSTAL_RS485_H
#define BYD_KOSTAL_RS485_H
#include <Arduino.h>
#include "../include.h"
#define RS485_INVERTER_SELECTED
#endif