first push
This commit is contained in:
1 parent
53c85e94af
commit
32f5ef9d3b
398 files changed
+1675
-140886
No files matched your search
@@ -0,0 +1,37 @@
|
||||
/*
|
||||
* 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;
|
||||
}
|
||||
|
||||
Reference in new issue
Block a user