Andrey/templates
2
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Объединить протокол терминала TMS2812 для Python и Android

Browse Source
This commit is contained in:
Andrey
2026-10-01 15:41:43 +03:00
parent e3e30fdad7
commit 3457657979
14 changed files with 729 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
c/set-protocol/src/pcan_abi.c
View File

@@ -168,6 +168,30 @@ uint16_t pcan_abi_tms2812_crc16(const uint8_t *data, size_t size)
return tms2812_crc16(data, size);
}
size_t pcan_abi_tms2812_build_fixed(uint8_t controller, uint8_t command,
const uint8_t *payload, size_t payload_size, uint8_t *output, size_t output_size)
{
return tms2812_build_fixed_request(controller, command, payload, payload_size, output, output_size);
}
size_t pcan_abi_tms2812_build_memory(uint8_t controller, uint8_t command,
uint32_t word_address, uint16_t value, uint8_t *output, size_t output_size)
{
return tms2812_build_memory_request(controller, command, word_address, value, output, output_size);
}
size_t pcan_abi_tms2812_build_test(uint8_t controller, uint16_t duration,
uint16_t pause, const uint8_t *digits, size_t digit_count, uint8_t *output, size_t output_size)
{
return tms2812_build_test_request(controller, duration, pause, digits, digit_count, output, output_size);
}
int pcan_abi_tms2812_validate_response(const uint8_t *data, size_t size,
uint8_t controller, uint8_t command, size_t full_size, int allow_short_tail)
{
return tms2812_validate_response(data, size, controller, command, full_size, allow_short_tail);
}
size_t pcan_abi_tms2812_build_upload(
uint8_t controller, uint32_t word_address, uint32_t byte_count,
uint8_t *output, size_t output_size)

55
c/set-protocol/src/tms2812.c
View File

@@ -18,6 +18,61 @@ uint16_t tms2812_crc16(const uint8_t *data, size_t size)
return set_crc16_modbus(data, size);
}
size_t tms2812_build_fixed_request(uint8_t controller, uint8_t command,
const uint8_t *payload, size_t payload_size, uint8_t *output, size_t output_size)
{
uint16_t crc;
if (output == NULL || (payload == NULL && payload_size != 0U) ||
payload_size > SIZE_MAX - 4U || output_size < payload_size + 4U) return 0U;
output[0] = controller;
output[1] = command;
if (payload_size != 0U) memcpy(output + 2U, payload, payload_size);
crc = tms2812_crc16(output, payload_size + 2U);
output[payload_size + 2U] = (uint8_t)crc;
output[payload_size + 3U] = (uint8_t)(crc >> 8);
return payload_size + 4U;
}
size_t tms2812_build_memory_request(uint8_t controller, uint8_t command,
uint32_t word_address, uint16_t value, uint8_t *output, size_t output_size)
{
uint8_t payload[8];
if (command == 0U) { command = TMS2812_CMD_PEEK; word_address = TMS2812_PING_ADDRESS; }
if (command != TMS2812_CMD_PEEK && command != TMS2812_CMD_POKE) return 0U;
put_le32(payload, word_address);
put_le32(payload + 4U, value);
return tms2812_build_fixed_request(controller, command, payload,
command == TMS2812_CMD_PEEK ? 4U : 8U, output, output_size);
}
size_t tms2812_build_test_request(uint8_t controller, uint16_t duration,
uint16_t pause, const uint8_t *digits, size_t digit_count,
uint8_t *output, size_t output_size)
{
uint8_t payload[16];
if (digits == NULL || digit_count != 12U) return 0U;
payload[0] = (uint8_t)duration; payload[1] = (uint8_t)(duration >> 8);
payload[2] = (uint8_t)pause; payload[3] = (uint8_t)(pause >> 8);
memcpy(payload + 4U, digits, 12U);
return tms2812_build_fixed_request(controller, TMS2812_CMD_TEST_ALL,
payload, sizeof payload, output, output_size);
}
int tms2812_validate_response(const uint8_t *data, size_t size,
uint8_t controller, uint8_t command, size_t full_size, int allow_short_tail)
{
size_t offset;
uint16_t crc;
if (data == NULL) return TMS2812_ERROR_ARGUMENT;
if (full_size < 6U) return TMS2812_ERROR_ARGUMENT;
if (size > full_size || size < full_size - (allow_short_tail ? 2U : 0U))
return TMS2812_ERROR_LENGTH;
if (data[0] != controller || data[1] != command) return TMS2812_ERROR_HEADER;
offset = full_size - 4U;
crc = (uint16_t)(data[offset] | ((uint16_t)data[offset + 1U] << 8));
return crc == tms2812_crc16(data, offset) ? TMS2812_OK : TMS2812_ERROR_CRC;
}
size_t tms2812_build_upload_request(
uint8_t controller, uint32_t word_address, uint32_t byte_count,
uint8_t *output, size_t output_size)