yuanjing/EC600U_esp32_iap_uart
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
main
EC600U_esp32_iap_uart/EC600U_uart1/com_poll.c

1065 lines
30 KiB
C
Raw Permalink Normal View History

temp
2024-02-05 17:39:56 +08:00
#include <stdint.h>
#include <string.h>
#include <time.h>
#include "ql_log.h"
#include "drv_uart.h"
#include "ModbusM.h"
#include "../EC600U_t2n/include/ModbusS.h"
#include "osi_api.h"
// no such file
// #include "minmea.h"
// #include "rtk_gps.h"
// #include "lv_demo_mcxa.h"
////////////////////////////////////////////////////////////////////////////////
#pragma pack(2)
typedef struct
{
short enc_val; // 编码器原始值 无效
short ss_1; // 1通道瞬时流量
short ss_2;
short flow_10cm_1; // 1通道瞬时流量
short flow_10cm_2;
uint16_t accumulate1;
uint16_t accumulate2;
uint16_t one_pile_work_time;
int ll_1; // 1通道累计流量
int ll_2;
short speed; // 速度
short depth; // 深度
unsigned short Ia; // a通道电流值
unsigned short Ib;
unsigned short Ic;
unsigned short cnt; // 计数 无效
short angle_x; // x轴角度
short angle_y;
short angle_z;
int dx; // 经度
int dy; // 维度
unsigned short id; // 桩点号
} user_data_t;
// #pragma pack() /*取消指定对齐，恢复缺省对齐*/
typedef struct
{
uint32_t UTC;
int64_t LAT;
int64_t LNG;
int32_t ALT;
int32_t speed;
uint8_t Q; // STATUS
int32_t fix_quality;
int16_t azimuth;
uint8_t total_gsv;
uint8_t total_gsa;
uint8_t id; // 对应的Gps编号
} gps_t;
#pragma pack(1)
/**
* @brief 业务部分t2n上报数据结构
*/
typedef struct
{
uint32_t TS;
int32_t LAT;
int32_t LNG;
int16_t ALT;
uint8_t Q;
int16_t azimuth;
int16_t pile_id;
uint8_t times;
int16_t depth;
uint16_t flow1;
uint16_t flow2;
int8_t tilt_x;
int8_t tilt_y;
uint16_t current1;
uint16_t current2;
} t2n_report_t;
#pragma pack()
struct minmea_time
{
uint8_t hours;
uint8_t minutes;
uint8_t seconds;
uint8_t rsv;
uint32_t microseconds;
};
struct minmea_date
{
uint8_t day;
uint8_t month;
uint16_t year;
};
////////////////////////////////////////////////////////////////////////////////
#define MAX(a, b) ((a) > (b) ? (a) : (b))
#define MIN(a, b) ((a) < (b) ? (a) : (b))
#define LOG_TAG "[com_poll]: "
#define ZB_CHANNEL 2
extern uint16_t gWordVar[];
device_t zb_device[ZB_CHANNEL];
static send_t zb_send[16];
#define GetTicks osiUpTime // monoclinic system time
int zbapi_send_write(device_t *device, send_t *sender);
int zbapi_send_req(device_t *device);
// static float pow_user(float x, float y)
// {
// int i;
// float tmp = 1;
// for (i = 0; i < y; i++)
// {
// tmp = tmp * x;
// }
// return tmp;
// }
static uint16_t bin2bcd(uint16_t bin)
{
uint16_t bcd;
uint8_t buf[4];
if (bin > 9999)
{
bin = 9999;
}
buf[0] = bin % 10;
bin /= 10;
buf[1] = bin % 10;
bin /= 10;
buf[2] = bin % 10;
buf[3] = bin / 10;
bcd = buf[0] | (buf[1] << 4) | (buf[2] << 8) | (buf[3] << 12);
return bcd;
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>sn ֵ
static uint8_t get_new_sn(int device_id)
{
int i;
int sn = 0;
for (i = 0; i < 16; i++)
{
if (zb_send[i].device_id == device_id)
{
sn = MAX(zb_send[i].sn, sn);
}
}
return sn + 1;
}
// <20><><EFBFBD><EFBFBD><EFBFBD>豸<EFBFBD><E8B1B8>Сsn<73><6E>Ӧ<EFBFBD><D3A6><EFBFBD>±<EFBFBD>
static int device_get_send(int device_id)
{
int i;
int sn = 255;
int min_index = -1;
for (i = 0; i < 16; i++)
{
if (zb_send[i].device_id == device_id)
{
if (zb_send[i].sn < sn)
{
sn = zb_send[i].sn;
min_index = i;
}
}
}
return min_index;
}
/*包错误处理*/
static void on_in_pack_error(device_t *device)
{
if (device->in_err_cnt[device->in_index] < device->in->max_err_cnt)
{
if (++device->in_err_cnt[device->in_index] >= device->in->max_err_cnt)
{
const packet_t *in_pack = device->in->packets + device->in_index;
int i;
for (i = 0; i < in_pack->length; i++)
{
uint32_t reg_addr = in_pack->local_addr + i;
if (reg_addr < gWORD_SIZE)
{
gWordVar[reg_addr] = 0;
}
}
if (device->protocol == 255)
{
if (in_pack->slave > 0 && in_pack->slave <= 10)
{
int i;
for (i = 0; i < 10; i++)
{
gWordVar[in_pack->local_addr] = 0;
}
}
if (in_pack->slave == 0)
{
gWordVar[64 + 10] = 0;
}
}
// on_data_error(device);
}
}
}
/*modbus主机根据slaveid进行轮询*/
void com_poll_modbus_master_poll(int n)
{
// QL_LOG(QL_LOG_LEVEL_INFO,"com_poll_modbus_master_poll","start");
if (n < 0)
return;
uint32_t now = GetTicks();
if (zb_device[n].status == 0) // 空闲状态
{
if (zb_device[n].out_pending > 0) // 如果有发送请求先处理发送
{
// QL_LOG(QL_LOG_LEVEL_INFO,"com_poll_modbus_master_poll","zb_device[n].out_pending > 0");
int send_index = device_get_send(n);
if (send_index >= 0)
{
// QL_LOG(QL_LOG_LEVEL_INFO,"com_poll_modbus_master_poll","send_index = %d",send_index);
if (now >= zb_send[send_index].next_try_time)
{
// QL_LOG(QL_LOG_LEVEL_INFO,"com_poll_modbus_master_poll","now >= zb_send[send_index].next_try_time");
zb_device[n].out_index = send_index;
zb_device[n].send_req_time = now;
zbapi_send_write(&zb_device[n], &zb_send[send_index]);
zb_device[n].status = 0x10;
return;
}
}
else
{
zb_device[n].out_pending = 0;
}
}
// QL_LOG(QL_LOG_LEVEL_INFO,"com_poll_modbus_master_poll","out_pending:%d, now:%d, next_scan_time:%d\n",zb_device[n].out_pending, now,zb_device[n].next_scan_time);
if (now >= zb_device[n].next_scan_time)
{
zb_device[n].send_req_time = now;
zbapi_send_req(&zb_device[n]);
zb_device[n].status = 2;
}
}
else if (zb_device[n].status == 1 || zb_device[n].status == 2)
{
if ((now - zb_device[n].send_req_time) > zb_device[n].in->time_out * 100)
{
// QL_LOG(QL_LOG_LEVEL_INFO,"com_poll_modbus_master_poll","1/2 now:%d - zb_device[n].send_req_time:%d > zb_device[n].in->time_out * 100:%d\n",now, zb_device[n].send_req_time, zb_device[n].in->time_out * 100);
zb_device[n].status = 0;
zb_device[n].ErrCode = 0x01;
zb_device[n].ErrCount++;
on_in_pack_error(&zb_device[n]);
if ((++zb_device[n].try_times >= zb_device[n].in->max_try_times) ||
(zb_device[n].in_err_cnt[zb_device[n].in_index] >= zb_device[n].in->max_err_cnt))
{
if (++zb_device[n].in_index >= zb_device[n].in->packet_cnt)
{
zb_device[n].in_index = 0;
zb_device[n].group_start_time = now;
}
zb_device[n].try_times = 0;
}
zb_device[n].next_scan_time = zb_device[n].group_start_time + zb_device[n].in->scan_rate * 10;
zb_device[n].status = 0;
}
}
else if (zb_device[n].status == 3) // <20><><EFBFBD>յ<EFBFBD><D5B5>ظ<EFBFBD>
{
if (++zb_device[n].in_index >= zb_device[n].in->packet_cnt)
{
zb_device[n].in_index = 0;
zb_device[n].group_start_time = now; //+ zb_device[n].in->scan_rate*10;
}
zb_device[n].next_scan_time = zb_device[n].group_start_time + zb_device[n].in->scan_rate * 10;
zb_device[n].status = 255;
zb_device[n].try_times = 0;
}
else if (zb_device[n].status == 0x10) // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѷ<EFBFBD><D1B7><EFBFBD><EFBFBD>ȴ<EFBFBD><C8B4><EFBFBD>Ӧ<EFBFBD><D3A6><EFBFBD>߳<EFBFBD>ʱ
{
int index = zb_device[n].out_index;
if ((now - zb_device[n].send_req_time) > zb_device[n].in->time_out * 100)
{
// QL_LOG(QL_LOG_LEVEL_INFO,"[uart1_modbus_master]:","0x10 now:%d - zb_device[n].send_req_time:%d > zb_device[n].in->time_out * 100:%d\n",now, zb_device[n].send_req_time, zb_device[n].in->time_out * 100);
zb_device[n].status = 0;
zb_device[n].ErrCode = 0x01;
zb_device[n].ErrCount++;
if (++zb_send[index].try_times >= zb_device[n].out->max_try_times) // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Դ<EFBFBD><D4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʧ<EFBFBD><CAA7>
{
zb_send[index].device_id = 0xff;
}
else
{
zb_send[index].next_try_time = now + zb_device[n].out->try_space * 100;
}
zb_device[n].status = 0;
zb_device[n].try_times = 0;
}
}
else if (zb_device[n].status == 0x11) // <20><><EFBFBD>յ<EFBFBD><D5B5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȷ<EFBFBD><C8B7>
{
zb_send[zb_device[n].out_index].device_id = 0xff;
zb_device[n].status = 255;
zb_device[n].try_times = 0;
}
else
{
if ((now - zb_device[n].revice_resp_time) >= (zb_device[n].in->scan_space * 10))
{
//QL_LOG(QL_LOG_LEVEL_INFO,"[uart1_modbus_master]:","else now:%d - zb_device[n].revice_resp_time:%d > zb_device[n].in->scan_space *10:%d\n",now, zb_device[n].revice_resp_time, zb_device[n].in->scan_space * 100);
zb_device[n].status = 0;
zb_device[n].try_times = 0;
}
}
}
static int intersection(int x0, int x1, int y0, int y1, int *s, int *e)
{
QL_LOG(QL_LOG_LEVEL_INFO, "[uart1_modbus_master]:", "enter intersection\n");
int ret = 0;
if ((y0 >= x0) && (y0 < x1))
{
*s = y0;
*e = MIN(x1, y1);
ret = 1;
}
else if ((y1 > x0) && (y1 <= x1))
{
*s = y1 - 1;
*e = MIN(x1, y1);
ret = 1;
}
else if ((x0 >= y0) && (x0 < y1))
{
*s = x0;
*e = MIN(y1, x1);
ret = 1;
}
else if ((x1 > y0) && (x1 <= y1))
{
*s = x1 - 1;
*e = MIN(y1, x1);
ret = 1;
}
return ret;
}
int zb_ModBusWordWriteHook(uint16_t addr, uint16_t length)
{
QL_LOG(QL_LOG_LEVEL_INFO, "[zb_ModBusWordWriteHook]:", "enter zb_ModBusWordWriteHook\n");
int i, j;
int ret = 0;
for (i = 0; i < ZB_CHANNEL; i++)
{
if (zb_device[i].out == NULL)
{
QL_LOG(QL_LOG_LEVEL_INFO, "[zb_ModBusWordWriteHook]:", "(zb_device[i].out == NULL");
continue;
}
for (j = 0; j < zb_device[i].out->packet_cnt; j++)
{
int s1, e1;
int s2, e2;
int s, e;
int n;
s1 = zb_device[i].out->packets[j].local_addr;
e1 = zb_device[i].out->packets[j].local_addr + zb_device[i].out->packets[j].length;
s2 = addr;
e2 = addr + length;
int c = intersection(s1, e1, s2, e2, &s, &e);
if (c)
{
QL_LOG(QL_LOG_LEVEL_INFO, "[zb_ModBusWordWriteHook]:", "intersection sucess\n");
for (n = 0; n < 16; n++)
{
if (zb_send[n].device_id == 0xff)
{
zb_send[n].sn = get_new_sn(i);
zb_send[n].device_id = i;
zb_send[n].packet_index = j;
zb_send[n].address = s;
zb_send[n].length = e - s;
zb_send[n].next_try_time = 0;
zb_send[n].try_times = 0;
zb_device[i].out_pending++;
QL_LOG(QL_LOG_LEVEL_INFO, "[zb_ModBusWordWriteHook]:", " zb_device[i].out_pending++, i = %d", i);
ret = 1;
break;
}
}
}
else
{
QL_LOG(QL_LOG_LEVEL_INFO, "[zb_ModBusWordWriteHook]:", "intersection fail\n");
}
}
}
return ret;
}
int zbapi_send_req(device_t *device)
{
if (device->protocol == 255)
{
device->txbuf[0] = device->in->packets[device->in_index].slave;
device->txbuf[1] = 0x5a;
device->txbuf[2] = 0xaa;
device->write(device->txbuf, 3);
}
else
{
uint16_t crc;
device->txbuf[0] = device->in->packets[device->in_index].slave;
device->txbuf[1] = device->in->packets[device->in_index].funcode;
device->txbuf[2] = device->in->packets[device->in_index].address >> 8;
device->txbuf[3] = device->in->packets[device->in_index].address & 0xff;
device->txbuf[4] = device->in->packets[device->in_index].length >> 8;
device->txbuf[5] = device->in->packets[device->in_index].length & 0xff;
crc = crc16(device->txbuf, 6);
device->txbuf[6] = crc >> 8;
device->txbuf[7] = crc & 0xff;
device->write(device->txbuf, 8);
}
gWordVar[507]++;
return 0;
}
int zbapi_send_write(device_t *device, send_t *sender)
{
{
int n = 0;
uint16_t crc;
const packet_t *out_pack = &device->out->packets[sender->packet_index];
if (sender->length == 0)
{
return 0;
}
device->txbuf[0] = device->out->packets[sender->packet_index].slave;
if (sender->length > 1)
{
int addr = out_pack->address + (sender->address - out_pack->local_addr);
int i;
int len;
device->txbuf[1] = 0x10;
device->txbuf[2] = addr >> 8;
device->txbuf[3] = addr & 0xff;
device->txbuf[4] = sender->length >> 8;
device->txbuf[5] = sender->length & 0xff;
device->txbuf[6] = (sender->length * 2) & 0xff;
len = 7;
for (i = 0; i < sender->length; i++)
{
uint16_t reg16 = gWordVar[sender->address + i];
if (out_pack->device_type == 5)
{
reg16 = bin2bcd(reg16);
}
device->txbuf[len++] = reg16 >> 8;
device->txbuf[len++] = reg16 & 0xff;
}
crc = crc16(device->txbuf, len);
device->txbuf[len++] = crc >> 8;
device->txbuf[len++] = crc & 0xff;
n += len;
}
else
{
int addr = out_pack->address + (sender->address - out_pack->local_addr);
uint16_t reg16 = gWordVar[sender->address];
device->txbuf[1] = 0x06;
device->txbuf[2] = addr >> 8;
device->txbuf[3] = addr & 0xff;
if (out_pack->device_type == 5)
{
reg16 = bin2bcd(reg16);
}
if ((device->protocol == 5) || (device->protocol == 6))
{
reg16 *= 10;
}
device->txbuf[4] = reg16 >> 8;
device->txbuf[5] = reg16 & 0xff;
crc = crc16(device->txbuf, 6);
device->txbuf[6] = crc >> 8;
device->txbuf[7] = crc & 0xff;
n += 8;
}
if (device->write != NULL)
{
device->write(device->txbuf, n);
}
}
return 1;
}
/*经过错误校验后判断后更新gwordvar里的数据*/
int com_poll_modbus_master_on_revice(int ch, uint8_t *rxbuf, int length)
{
QL_LOG(QL_LOG_LEVEL_INFO, LOG_TAG, "enter com_poll_modbus_master_on_revice\n");
int i;
// uint8_t src_addr[8];
if (length < 4)
{
return -1;
}
i = ch;
// for(i=0; i<ZB_CHANNEL; i++) // 1
{
if (zb_device[i].status == 2)
{
zb_device[i].revice_resp_time = GetTicks();
{
int index = zb_device[i].in_index;
if ((zb_device[i].in->packets[index].slave == rxbuf[0]) &&
zb_device[i].in->packets[index].funcode == rxbuf[1])
{
uint16_t crcChk = crc16(rxbuf, length - 2);
uint16_t crcData = (rxbuf[length - 2] << 8) | rxbuf[length - 1];
if (crcData != crcChk)
{
zb_device[i].ErrCode = 2; // CRC error
zb_device[i].ErrCount++;
}
else if (rxbuf[0] != zb_device[i].in->packets[index].slave)
{
zb_device[i].ErrCode = 3; // ADD error
zb_device[i].ErrCount++;
}
else if (rxbuf[1] != zb_device[i].in->packets[index].funcode)
{
zb_device[i].ErrCode = 4; // Fun err;
zb_device[i].ErrCount++;
}
else if (rxbuf[2] != (zb_device[i].in->packets[index].length * 2))
{
zb_device[i].ErrCode = 1; // byte miss
zb_device[i].ErrCount++;
}
else
{
int n = 0;
// uint32_t reg32;
uint16_t addr = zb_device[i].in->packets[index].local_addr;
uint8_t len = rxbuf[2] / 2;
if (addr >= gWORD_SIZE)
{
zb_device[i].ErrCode = 5; // regaddr err;
goto done;
}
zb_device[i].ErrCode = 0;
gWordVar[508]++;
switch (zb_device[i].in->packets[index].device_type)
{
// case 35: // <20><><EFBFBD>DZ<EFBFBD>V2_SCADA
// {
// // gWordVar[addr+1] = (rxbuf[3+2+6] << 8) + (rxbuf[3+2+7]); // <20>趨
// // gWordVar[addr+2] = (rxbuf[3+2+0] << 8) + (rxbuf[3+2+1]); // ˲ʱ
// // gWordVar[addr+3] = (rxbuf[3+2+2] << 8) + (rxbuf[3+2+3]); // <20>ۼ<EFBFBD>
// // gWordVar[addr+4] = (rxbuf[3+2+4] << 8) + (rxbuf[3+2+5]);
// gWordVar[12] = 666;
// // on_data_update_scada(&zb_device[i]);
// } break;
default:
if (zb_device[n].out_pending > 0)
{
break;
}
for (n = 0; n < len; n++)
{
if (addr + n < gWORD_SIZE)
{
gWordVar[addr + n] = (rxbuf[3 + n * 2] << 8) | (rxbuf[3 + n * 2 + 1]);
}
else
{
break;
}
}
break;
}
if (zb_device[i].in->packets[index].cb)
{
zb_device[i].in->packets[index].cb(&gWordVar[addr], len);
}
zb_device[i].in_err_cnt[zb_device[i].in_index] = 0;
}
done:
zb_device[i].status = 3;
// LSAPI_Log_Debug(LOG_TAG "ErrCode:%d\n", zb_device[i].ErrCode);
}
else
{
// LSAPI_Log_Debug(LOG_TAG "slave:%d, rxbuf[0]:%d, funcode:%d, rxbuf[1]:%d\n",
// zb_device[i].in->packets[zb_device[i].in_index].slave, rxbuf[0],
// zb_device[i].in->packets[zb_device[i].in_index].funcode, rxbuf[1]);
}
gWordVar[510] = zb_device[i].ErrCode;
gWordVar[509] = zb_device[i].ErrCount;
}
}
else if (zb_device[i].status == 0x10)
{
// LSAPI_Log_Debug(LOG_TAG "status:0x10\n");
zb_device[i].revice_resp_time = GetTicks();
// if(memcmp(src_addr,((zb_dev_t*)zb_device[i].ext)->zb_addr,8) == 0)
{
zb_device[i].status = 0x11;
}
}
else
{
// LSAPI_Log_Debug(LOG_TAG "state:%d\n", zb_device[i].status);
}
}
return 0;
}
// const int reg_offset[] = {0, 2, 3, 4, 1};
// static char input_buf[1][414];
// static char output_buf[1][212];
static char in_err_cnt_buf[1][25];
static uint8_t uart_txbuf[256];
// static uint8_t uart_rxbuf[256];
extern drvUart_t *drvuart1;
static int com_poll_uart_send(uint8_t *buf, int len)
{
// QL_LOG(QL_LOG_LEVEL_INFO, "[uart1_modbus_master]:" ,"enter com_poll_uart_send\n");
if (!drvuart1)
{
// QL_LOG(QL_LOG_LEVEL_INFO, "[uart1_modbus_master]:" ,"drvuart1 device is null\n");
return -1;
}
else
{
// QL_LOG(QL_LOG_LEVEL_INFO, "[uart1_modbus_master]:" ,"drvuart1 device is not null\n");
}
int ret = drvUartSend((drvUart_t *)drvuart1, (void *)buf, len);
if (ret < 0)
{
// QL_LOG(QL_LOG_LEVEL_INFO, "[uart1_modbus_master]:" ,"com_poll_uart_send failed!!, ret:%d\n", ret);
}
else
{
// QL_LOG(QL_LOG_LEVEL_INFO, "[uart1_modbus_master]:" ,"com_poll_uart_send sucess!!, ret:%d\n", ret);
}
return ret;
}
#if 0
user_data_t user_data; // modbus处理线程与ui线程通信的数据缓冲区
extern osiThread_t *lvgl_thread; //extern LSAPI_OSI_Thread_t *lvgl_thread; ui处理线程
extern osiThread_t *gps_thread; //extern LSAPI_OSI_Thread_t *gps_thread; gps数据处理线程
//extern gps_t gps1_parse; // gps1解析数据缓冲区
extern osiMessageQueue_t *t2n_report_msg; //extern LSAPI_OSI_MessageQueue_t *t2n_report_msg; // t2n report消息队列
extern osiSemaphore_t *t2n_report_sema; //extern LSAPI_OSI_Semaphore_t *t2n_report_sema; t2n report信号量
#endif
extern osiThread_t *lvgl_thread; // extern LSAPI_OSI_Thread_t *lvgl_thread; ui处理线程
extern osiThread_t *gps_thread; // extern LSAPI_OSI_Thread_t *gps_thread; gps数据处理线程
extern gps_t gps1_parse; // gps1解析数据缓冲区
extern osiMessageQueue_t *t2n_report_msg; // extern LSAPI_OSI_MessageQueue_t *t2n_report_msg; // t2n report消息队列
extern osiSemaphore_t *t2n_report_sema; // extern LSAPI_OSI_Semaphore_t *t2n_report_sema; t2n report信号量
static t2n_report_t t2n_report; // t2n_report 上报数据缓冲区
// static uint16_t last_cnt = 0;
// static int first_working = true;
// #define COM_POLL_APP_UART_RECV_BUF_LEN 512 // app uart接收缓冲区长度
// static uint8_t app_input_str[COM_POLL_APP_UART_RECV_BUF_LEN]; // appuart modbus接收缓冲区
int16_t g_depth_last = -1;
//-----------------------------------------------------------------------------------------------------
#define FLOW1_REG_ADDR (0)
#define FLOW2_REG_ADDR (6)
#define DEPTH_REG_ADDR (12)
#define RECORD_REG_ADDR (32)
#define AC_CURRENT_REG_ADDR_1 24
#define AC_CURRENT_REG_ADDR_2 25
#define AC_CURRENT_REG_ADDR_3 26
#define MOVE_REG_ADDR 27 // 3
#define TILT_SENSER_ADDR_X 30
#define TILT_SENSER_ADDR_Y 31
#define TILT_ZHUANGDIAN_NUM_ADDR_Y 32
#define TIME 264
// #define CAL_4_20MA_ADDR 384
typedef struct
{
int16_t flow_;
int16_t flow; // 瞬时流量
int32_t total_flow; // 累计累计流量
uint32_t update_time;
} flow_t;
// flow_t *pflow = (flow_t *)&gWordVar[FLOW_REG_ADDR];
typedef struct
{
int16_t up_down;
int16_t speed;
int16_t depth;
uint16_t sample_count;
uint16_t depth_flow[2]; // flow1/2
uint32_t last_total_flow[2];
int16_t depth_offset;
uint16_t one_pile_work_time;
} depth_t;
typedef struct
{
uint16_t reset_cmd;
uint16_t pile_id;
uint16_t count;
uint16_t work_time;
struct _item
{
int16_t speed;
int16_t depth;
int16_t flow[2];
uint32_t total_flow[2];
int16_t tilt_x;
int16_t tilt_y;
uint16_t current1;
uint16_t current2;
} item[10];
} record_t;
// static uint32_t date_time2utc(struct minmea_date *date, struct minmea_time *time)
// {
// struct tm gps_time;
// uint32_t gps_utc;
// gps_time.tm_hour = time->hours;
// gps_time.tm_min = time->minutes;
// gps_time.tm_sec = time->seconds;
// gps_time.tm_year = date->year + 2000 - 1900;
// gps_time.tm_mon = date->month - 1;
// gps_time.tm_mday = date->day;
// gps_utc = mktime(&gps_time);
// return gps_utc;
// }
// depth_t *depth_data = (depth_t *)&gWordVar[DEPTH_REG_ADDR];
// modbus排布 = (1 + 2通道flow_t) + (深度depth_t) +
//-----------------------------------------------------------------------------------------------------
extern user_data_t g_ui_user_data;
/**
* @brief modbus接收的ui数据处理
*
* @param modbus_recv_reg
* @param b
*/
extern int drp_write(uint8_t endpoint, uint8_t flag, uint16_t tran_id, void *data, int length);
uint16_t tran_id = 0;
uint16_t last_record_count = 0;
#if 1
static void recv_ui_data_cb(uint16_t *modbus_recv_reg, int b)
{
if (modbus_recv_reg == NULL)
return;
depth_t *depth = (depth_t *)&gWordVar[DEPTH_REG_ADDR];
flow_t *flow1 = (flow_t *)&gWordVar[FLOW1_REG_ADDR];
flow_t *flow2 = (flow_t *)&gWordVar[FLOW2_REG_ADDR];
// ## 1
// t2n_report_t *temp = &t2n_report;
// ## WARN: 注意变量类型-类型转换
g_ui_user_data.ss_1 = flow1->flow;
g_ui_user_data.ll_1 = flow1->total_flow;
g_ui_user_data.ss_2 = flow2->flow;
g_ui_user_data.ll_2 = flow2->total_flow;
g_ui_user_data.accumulate1 = depth->depth_flow[0];
g_ui_user_data.accumulate1 = depth->depth_flow[1];
g_ui_user_data.depth = depth->depth;
g_ui_user_data.speed = depth->speed;
g_ui_user_data.Ia = (int16_t)gWordVar[AC_CURRENT_REG_ADDR_1];
g_ui_user_data.Ib = (int16_t)gWordVar[AC_CURRENT_REG_ADDR_2];
g_ui_user_data.Ic = (int16_t)gWordVar[AC_CURRENT_REG_ADDR_3];
g_ui_user_data.angle_x = (int16_t)gWordVar[TILT_SENSER_ADDR_X];
g_ui_user_data.angle_y = (int16_t)gWordVar[TILT_SENSER_ADDR_Y];
g_ui_user_data.one_pile_work_time = depth->one_pile_work_time;
// user_data.ss_1 = flow1->flow; // 1通道瞬时流量
// user_data.ll_1 = flow1->total_flow; // 1通道累计流量
// flow_t *flow2 = (flow_t *)&modbus_recv_reg[FLOW2_REG_ADDR];
// user_data.ss_2 = flow2->flow;
// user_data.ll_2 = flow2->total_flow;
// user_data.depth = depth->depth; // 深度
// user_data.speed = depth->speed; // 速度
// user_data.angle_x = (int16_t)modbus_recv_reg[TILT_SENSER_ADDR_X];
// user_data.angle_y = (int16_t)modbus_recv_reg[TILT_SENSER_ADDR_Y];
// log_printf(LINFO, LOG_TAG "ss_1:%d, ll_1:%d, ss_2:%d, ll_2:%d, depth:%d, speed:%d, angle_x:%d, angle_y:%d\n",
// user_data.ss_1, user_data.ll_1, user_data.ss_2, user_data.ll_2, user_data.depth,
// user_data.speed, user_data.angle_x, user_data.angle_y);
/*! @note: 向ui界面发送用户数据 */
if (lvgl_thread != NULL)
{
// LSAPI_OSI_Event_t send_event;
osiEvent_t send_event;
send_event.id = 9; // BK_EVENT_UI_USER_DATA_ID;
send_event.param1 = (uint32_t)&g_ui_user_data;
// LSAPI_OSI_EvnetSend(lvgl_thread, &send_event);
osiEventSend(lvgl_thread, &send_event);
}
/*! @note: 向t2n上报数据 */
record_t *record = (record_t *)&gWordVar[RECORD_REG_ADDR];
if (record->count != last_record_count)
{ // sample_count数据变化时需要对t2n数据进行上报处理
// flow1,2 times TS
t2n_report_t *temp = &t2n_report;
last_record_count = record->count;
temp->times = record->count;
// temp->timeline = record->;
temp->current1 = gWordVar[AC_CURRENT_REG_ADDR_1];
temp->current2 = gWordVar[AC_CURRENT_REG_ADDR_2];
temp->depth = record->item[0].depth;
// temp->speed = record->item[0].speed;
temp->flow1 = record->item[0].flow[0];
// temp->toatal_flow1 = record->item[0].total_flow[0];
temp->flow2 = record->item[0].flow[1];
// temp->toatal_flow2 = record->item[0].total_flow[1];
temp->pile_id = record->pile_id;
temp->tilt_x = g_ui_user_data.angle_x;
temp->tilt_y = g_ui_user_data.angle_y;
temp->LNG = gps1_parse.LNG % 0x100000000ul;
// temp->LNG_H = gps1_parse.LNG / 0x100000000ul;
temp->LAT = gps1_parse.LAT % 0x100000000ul;
// temp->LAT_H = gps1_parse.LAT / 0x100000000ul;
temp->ALT = gps1_parse.ALT % 0x10000;
// temp->ALT_H = gps1_parse.ALT / 0x10000;
temp->Q = gps1_parse.Q;
temp->azimuth = gps1_parse.azimuth;
// temp->UTC = date_time2utc(&gps1_parse.date, &gps1_parse.time);
drp_write(50, 2, ++tran_id, temp, sizeof(t2n_report_t));
// log_printf(LINFO, LOG_TAG "drp_write ep=%d,len=%d,alt=%d\n", 50, sizeof(t2n_report_t), gps1_parse.ALT);
// ##
// if ((t2n_report_sema != NULL) && (t2n_report_msg != NULL))
// { // 放到消息队列中，进行t2n数据上报
// LSAPI_OSI_SemaphoreRelease(t2n_report_sema);
// LSPAI_OSI_MessageQueuePut(t2n_report_msg, (void *)(temp));
// }
// if (lvgl_thread != NULL)
// { // 向ui界面发送t2n上报数据
// LSAPI_OSI_Event_t send_event;
// send_event.id = BK_EVENT_T2N_REPORT_ID;
// send_event.param1 = (uint32_t)temp;
// LSAPI_OSI_EvnetSend(lvgl_thread, &send_event);
// }
// g_depth_last = depth_val;
} // 数据没有变化时什么也不做
// ## 2
// if ((bl0939_sema != NULL) && (bl0939_msg != NULL)) {
// LSAPI_OSI_SemaphoreRelease(bl0939_sema);
// LSPAI_OSI_MessageQueuePut(bl0939_msg, (void *)(modbus_recv_reg + 11));
// }
}
#endif
struct input
{
input_t input;
packet_t packet[5];
};
struct output
{
output_t output;
packet_t packet[5];
};
struct input input1;
struct output output1;
/**
* @brief com_poll任务初始化
*
*/
void com_poll_init(void)
{
QL_LOG(QL_LOG_LEVEL_INFO, LOG_TAG, "enter com_poll_init\n");
int i = 0;
// int meter_count[4] = {0, 0, 0, 0};
// int size;
// char *p;
// int n;
uint8_t *in_err_cnt;
zb_device[0].txbuf = uart_txbuf;
zb_device[0].txbuf_size = sizeof(uart_txbuf);
zb_device[0].write = com_poll_uart_send; // return 8
QL_LOG(QL_LOG_LEVEL_INFO, LOG_TAG, "zb_device[0].write = %d\n", zb_device[0].write);
{
input_t *input;
output_t *output;
// uint8_t *in_err_cnt;
// int tmp1 = sizeof(input_buf[i]);
// int tmp2 = sizeof(output_buf[i]);
// int tmp3 = sizeof(in_err_cnt_buf[i]);
// memset(input_buf[i], 0, sizeof(input_buf[i]));
// memset(output_buf[i], 0, sizeof(output_buf[i]));
// memset(in_err_cnt_buf[i], 0, sizeof(in_err_cnt_buf[i]));
memset(&output1, 0, sizeof(output1));
memset(&input1, 0, sizeof(input1));
memset(in_err_cnt_buf, 0, sizeof(in_err_cnt_buf));
output = &output1.output; //(output_t *)output_buf[i];
input = &input1.input; // (input_t *)input_buf[i];
in_err_cnt = (uint8_t *)in_err_cnt_buf[i];
zb_device[i].in_err_cnt = in_err_cnt;
input->scan_rate = 5; //*20ms 扫描周期时间
input->time_out = 5; //*100ms 超时时间
input->max_try_times = 2;
input->scan_space = 4; //*100ms
input->max_err_cnt = 30;
output->max_try_times = 3;
output->try_space = 20;
zb_device[i].channl = i;
zb_device[i].next_scan_time = 0;
zb_device[i].status = 0;
zb_device[i].try_times = 0;
zb_device[i].in_index = 0;
zb_device[i].out_pending = 0;
zb_device[i].in_err_cnt = in_err_cnt;
zb_device[i].in = input;
zb_device[i].out = output;
// zb_device[i].ext = &serial_port_cfg[i];
}
{
device_t *dev = (device_t *)&zb_device;
/*! @note: ui数据处理-回调处理 */
dev->in->packets[dev->in->packet_cnt].slave = 1;
dev->in->packets[dev->in->packet_cnt].funcode = 3;
dev->in->packets[dev->in->packet_cnt].address = 0;
dev->in->packets[dev->in->packet_cnt].length = 64;
dev->in->packets[dev->in->packet_cnt].device_type = 0;
dev->in->packets[dev->in->packet_cnt].local_addr = 0;
dev->in->packets[dev->in->packet_cnt].ch = 0;
dev->in->packets[dev->in->packet_cnt].cb = recv_ui_data_cb;
dev->in->packet_cnt++;
// /*! @note: t2n数据处理-回调处理 */
// 读配置文件
dev->in->packets[dev->in->packet_cnt].slave = 1;
dev->in->packets[dev->in->packet_cnt].funcode = 3;
dev->in->packets[dev->in->packet_cnt].address = 384;
dev->in->packets[dev->in->packet_cnt].length = 64;
dev->in->packets[dev->in->packet_cnt].device_type = 0;
dev->in->packets[dev->in->packet_cnt].local_addr = 384;
dev->in->packets[dev->in->packet_cnt].ch = 0;
dev->in->packets[dev->in->packet_cnt].cb = NULL;
dev->in->packet_cnt++;
/*! @note: 循环推送的数据-回调处理 */
dev->out->packets[dev->out->packet_cnt].slave = 1;
dev->out->packets[dev->out->packet_cnt].funcode = 6;
dev->out->packets[dev->out->packet_cnt].local_addr = 12;
dev->out->packets[dev->out->packet_cnt].length = 1;
dev->out->packets[dev->out->packet_cnt].address = 12;
dev->out->packets[dev->out->packet_cnt].device_type = 0;
dev->out->packets[dev->out->packet_cnt].ch = 0;
dev->out->packet_cnt++;
dev->out->packets[dev->out->packet_cnt].slave = 1;
dev->out->packets[dev->out->packet_cnt].funcode = 6;
dev->out->packets[dev->out->packet_cnt].local_addr = 32;
dev->out->packets[dev->out->packet_cnt].length = 1;
dev->out->packets[dev->out->packet_cnt].address = 32;
dev->out->packets[dev->out->packet_cnt].device_type = 0;
dev->out->packets[dev->out->packet_cnt].ch = 0;
dev->out->packet_cnt++;
dev->out->packets[dev->out->packet_cnt].slave = 1;
dev->out->packets[dev->out->packet_cnt].funcode = 6;
dev->out->packets[dev->out->packet_cnt].local_addr = 384;
dev->out->packets[dev->out->packet_cnt].length = 128;
dev->out->packets[dev->out->packet_cnt].address = 384;
dev->out->packets[dev->out->packet_cnt].device_type = 0;
dev->out->packets[dev->out->packet_cnt].ch = 0;
dev->out->packet_cnt++;
}
for (int i = 0; i < 16; i++)
{
zb_send[i].device_id = 0xff;
}
}
int fill_data(uint8_t *pData, uint16_t local_addr, uint8_t remote_offset, uint8_t length)
{
uint16_t *pWordVar;
int i;
*pData++ = remote_offset;
*pData++ = length;
pWordVar = &gWordVar[local_addr];
for (i = 0; i < length; i++)
{
*pData++ = *pWordVar >> 8;
*pData++ = *pWordVar & 0xff;
pWordVar++;
}
return i * 2 + 2;
}
int build_data(int dest_addr, const int *src_addr_map, int length)
{
int i;
int change_cnt = 0;
for (i = 0; i < length; i++)
{
int src_addr = src_addr_map[i];
if (dest_addr < gWORD_SIZE && src_addr >= 0 && src_addr < gWORD_SIZE)
{
if (gWordVar[dest_addr] != gWordVar[src_addr])
{
gWordVar[dest_addr] = gWordVar[src_addr];
change_cnt++;
}
}
else
{
return -1;
}
dest_addr++;
}
return change_cnt;
}
int copy_data(int dest_addr, int src_addr, int length)
{
int i;
int change_cnt = 0;
for (i = 0; i < length; i++)
{
// int src_addr = src_addr_map[i];
if (dest_addr < gWORD_SIZE && src_addr >= 0 && src_addr < gWORD_SIZE)
{
if (gWordVar[dest_addr] != gWordVar[src_addr])
{
gWordVar[dest_addr] = gWordVar[src_addr];
change_cnt++;
}
}
else
{
return -1;
}
dest_addr++;
src_addr++;
}
return change_cnt;
}
Reference in New Issue Copy Permalink