first push

This commit is contained in:
claw committed 2026-04-02 17:52:12 +08:00
1 parent 53c85e94af
commit 32f5ef9d3b
398 files changed
+1675 -140886

No files matched your search

+37
View File
@@ -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;
}