38 lines
1.1 KiB
C
38 lines
1.1 KiB
C
/*
|
|
* smlMaster.c
|
|
*
|
|
* Created on: Apr 15, 2025
|
|
* Author: 18896
|
|
*/
|
|
#include "main.h"
|
|
#include "slmpMaster.h"
|
|
|
|
SLMPSTATUS slmp_master_status = slmp_writeRxDone;
|
|
uint8_t readRespHeader[7] = { 0xD0, 0x00, 0x00, 0xFF, 0xFF, 0x03, 0x00 };
|
|
SMLPFrame frame = { .frameStruct.header = 0x0050, .frameStruct.taget = 0xff00, .frameStruct.index = 0x03FF, .frameStruct.subIdx = 0x00, .frameStruct.timeout = 0x0004, .frameStruct.subCmd = 0x0000, .frameStruct.DM = 0xA8 };
|
|
|
|
uint24_t u32_to_u24(uint32_t val) {
|
|
uint24_t r;
|
|
r.byte0 = val & 0xFF;
|
|
r.byte1 = (val >> 8) & 0xFF;
|
|
r.byte2 = (val >> 16) & 0xFF;
|
|
return r;
|
|
}
|
|
|
|
uint16_t handleSMLP_ReadTX(uint32_t start, uint16_t size) {
|
|
frame.frameStruct.cmd = 0x0401;
|
|
frame.frameStruct.requestSize = 0x000c;
|
|
frame.frameStruct.start = u32_to_u24(start);
|
|
frame.frameStruct.size = size;
|
|
return 21;
|
|
}
|
|
|
|
uint16_t handleSLMP_WriteTX(uint32_t start, uint16_t size) {
|
|
frame.frameStruct.cmd = 0x1401;
|
|
frame.frameStruct.requestSize = 0x000C + (size * 2);
|
|
frame.frameStruct.start = u32_to_u24(start);
|
|
frame.frameStruct.size = size;
|
|
return size * 2 + 21;
|
|
}
|
|
|