debug modbus slave
This commit is contained in:
@@ -3,8 +3,21 @@
|
||||
|
||||
#include "chrg_pkg.h"
|
||||
|
||||
int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data)
|
||||
int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
rt_uint8_t len_in, rt_uint8_t *data_out, rt_uint8_t *len_out)
|
||||
{
|
||||
if ((RT_NULL == data_in)||(RT_NULL == data_out)||(0 == len_in)) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
data_out[0] = 5+len_in;
|
||||
data_out[1] = 0x00;
|
||||
data_out[2] = id;
|
||||
data_out[3] = cmd;
|
||||
memcpy(&data_out[4], data_in, len_in);
|
||||
data_out[len_in+4] = calc_crc8(data_out, len_in+4);
|
||||
|
||||
*len_out = 5+len_in;
|
||||
|
||||
return 0;
|
||||
}
|
||||
@@ -16,4 +29,25 @@ int chrg_pkg_decode (eIDX_ID id, rt_uint8_t *data)
|
||||
return 0;
|
||||
}
|
||||
|
||||
int chrg_pkg_send (eIDX_TTY idx, rt_uint8_t *data, rt_uint16_t len)
|
||||
{
|
||||
rt_ssize_t ret = -1;
|
||||
struct chrg_tty_t *pTTY = RT_NULL;
|
||||
|
||||
switch (idx) {
|
||||
case IDX_TTY_NORTH:
|
||||
// pTTY = chrgnorth.tty;
|
||||
break;
|
||||
case IDX_TTY_SOUTH:
|
||||
// pTTY = chrgsouth.tty;
|
||||
break;
|
||||
}
|
||||
|
||||
if ((RT_NULL != pTTY)&&(RT_NULL != pTTY->dev)) {
|
||||
ret = rt_device_write(pTTY->dev, 0, data, len);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -3,12 +3,16 @@
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
#include "chrg_tty.h"
|
||||
#include "chrg_def.h"
|
||||
|
||||
extern int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data);
|
||||
extern int chrg_pkg_encode (eIDX_ID id, rt_uint8_t cmd, rt_uint8_t *data_in,
|
||||
rt_uint8_t len_in, rt_uint8_t *data_out, rt_uint8_t *len_out);
|
||||
|
||||
extern int chrg_pkg_decode (eIDX_ID id, rt_uint8_t *data);
|
||||
|
||||
extern int chrg_pkg_send (eIDX_TTY idx, rt_uint8_t *data, rt_uint16_t len);
|
||||
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
@@ -6,26 +6,20 @@
|
||||
|
||||
#include "chrg_utils.h"
|
||||
|
||||
void source_get_vc (rt_uint16_t vol, rt_uint16_t cur)
|
||||
int source_get_vc (rt_uint16_t vol, rt_uint16_t cur)
|
||||
{
|
||||
rt_size_t len = 0;
|
||||
rt_uint8_t data[12] = {0};
|
||||
rt_uint8_t frame[16] = {0};
|
||||
|
||||
data[0] = 0x0B;
|
||||
data[1] = 0x00;
|
||||
data[2] = ID_SOURCE;
|
||||
data[3] = SRC_CMD_GET_VOLTAGE;
|
||||
u16_to_u8v(vol, &data[0]);
|
||||
u16_to_u8v(cur, &data[2]);
|
||||
data[4] = 0x00;
|
||||
data[5] = 0x00;
|
||||
|
||||
u16_to_u8v(vol, &data[4]);
|
||||
u16_to_u8v(cur, &data[6]);
|
||||
chrg_pkg_encode(ID_SOURCE, SRC_CMD_GET_VOLTAGE, data, 6, frame, &len);
|
||||
|
||||
data[8] = 0x00;
|
||||
data[9] = 0x00;
|
||||
data[10] = calc_crc8(data, 10);
|
||||
|
||||
len = 0x0B;
|
||||
|
||||
chrg_north_send(data, len);
|
||||
return chrg_pkg_send(IDX_TTY_SOUTH, frame, len);
|
||||
}
|
||||
|
||||
void source_get_pd (void)
|
||||
|
||||
Reference in New Issue
Block a user