123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190 |
- #include "protocol.h"
- #include "process.h"
- #include "cfg.h"
- #include "uart.h"
- #ifdef IS_BOOTLOADER
- uint32_t Firmware_Version[4] = {1, 0, 0, 20240725};
- #else
- uint32_t Firmware_Version[4] = {1, 1, 1, 20240726};
- #endif
- uint16_t Read_FirmwareVersion(uint8_t *pBuf, uint16_t buf_len)
- {
- int i;
-
- if( buf_len < 16){
- return 0;
- }
-
- for (i = 0; i < 4; ++i)
- {
- pBuf[i * 4] = (Firmware_Version[i] >> 24) & 0xff;
- pBuf[i * 4 + 1] = (Firmware_Version[i] >> 16) & 0xff;
- pBuf[i * 4 + 2] = (Firmware_Version[i] >> 8) & 0xff;
- pBuf[i * 4 + 3] = (Firmware_Version[i] >> 0) & 0xff;
- }
-
- return 16;
-
- }
- uint16_t Read_HardwareVersion(uint8_t *pBuf, uint16_t buf_len)
- {
- if( buf_len < 2){
- return 0;
- }
-
- pBuf[0] = (config->hw_version >> 8)&0xff;
- pBuf[1] = (config->hw_version >> 0)&0xff;
-
- return 2;
- }
- uint16_t Read_Deviceid(uint8_t *pBuf, uint16_t buf_len)
- {
- if( buf_len < 4){
- return 0;
- }
-
- pBuf[0] = (config->deviceid >> 24)&0xff;
- pBuf[1] = (config->deviceid >> 16)&0xff;
- pBuf[2] = (config->deviceid >> 8)&0xff;
- pBuf[3] = (config->deviceid >> 0)&0xff;
-
- return 4;
-
- }
- uint16_t Read_Devicetype(uint8_t *pBuf, uint16_t buf_len)
- {
- if( buf_len < 2){
- return 0;
- }
-
- pBuf[0] = (config->devicetype >> 8)&0xff;
- pBuf[1] = (config->devicetype >> 0)&0xff;
-
- return 2;
- }
- uint16_t Read_Addr(uint8_t *pBuf, uint16_t buf_len)
- {
- if( buf_len < 2){
- return 0;
- }
-
- pBuf[0] = 0x00;
- pBuf[1] = config->addr;
-
- return 2;
- }
- uint16_t Read_Baudrate(uint8_t *pBuf, uint16_t buf_len)
- {
- if( buf_len < 2){
- return 0;
- }
-
- pBuf[0] = 0x00;
- pBuf[1] = config->br_index;
-
- return 2;
- }
- uint16_t Read_LockStatus(uint8_t *pBuf, uint16_t buf_len)
- {
- if( buf_len < 4){
- return 0;
- }
-
- pBuf[0] = Process_LockStatus();
- pBuf[1] = Process_UnlockStatus();
- pBuf[2] = Process_CoverStatus();
- pBuf[3] = 0x00;
-
- return 4;
- }
- /*=======================================================================================*/
- uint8_t Write_Addr(uint8_t *pdata, uint8_t len)
- {
- if(len == 2){
- config->addr = pdata[1];
- return RET_OK|RET_NEED_SAVE;
-
- }else{
- return RET_DATAINVALID;
- }
- }
- uint8_t Write_Baudrate(uint8_t *pdata, uint8_t len)
- {
- if(len == 2){
- if(pdata[1] >= BaudRate_4800 && pdata[1] <= BaudRate_230400){
- config->br_index = pdata[1];
- return RET_OK|RET_NEED_SAVE;
-
- }else{
- return RET_DATAINVALID;
- }
-
-
- }else{
- return RET_DATAINVALID;
- }
- }
- uint8_t Write_HardwareVersion(uint8_t *pdata, uint8_t len)
- {
- if(len == 2){
-
- config->hw_version = ((uint16_t)pdata[0]<<8) | pdata[1];
- return RET_OK|RET_NEED_SAVE;
-
- }else{
- return RET_DATAINVALID;
- }
-
- }
- uint8_t Write_Deviceid(uint8_t *pdata, uint8_t len)
- {
- if(len == 4){
- config->deviceid = ((uint32_t)pdata[0]<<24) | ((uint32_t)pdata[1]<<16)| ((uint32_t)pdata[2]<<8)| pdata[3];
- return RET_OK|RET_NEED_SAVE;
-
- }else{
- return RET_DATAINVALID;
- }
- }
- uint8_t Write_Devicetype(uint8_t *pdata, uint8_t len)
- {
- if(len == 2){
-
- config->devicetype = ((uint16_t)pdata[0]<<8) | pdata[1];
- return RET_OK|RET_NEED_SAVE;
-
- }else{
- return RET_DATAINVALID;
- }
- }
|