#include "tran_for_coder2.h" #include "debug.h" #include "mymisc.h" #include "mystdlib.h" #include "board.h" #include "dev_flash.h" #include "tcp.h" #include "prot_uc.h" #include "handle_for_coder.h" #include "handle_for_checker.h" // 这个文件解析跟赋码仪相关的命令 typedef struct{ ucport_def u; uint8_t addrs_num; char year[10]; char uid[10][20]; uint8_t ack[380]; uint8_t ack_num; void (*doexert)(ucport_def *u); }write_uid_def; // 注码完成 static void write_uid_end(ucport_def *u,port_mcu *src,void *data,int ack,char *err_str) { write_uid_def *w=(write_uid_def *)u; uint8_t addr=port_get_addr(src); if(addr<=0||addr>10){ DBG_WARN("addr err:%d",addr); return; } w->ack[addr-1]=ack; w->ack_num++; if(w->ack_num>=10) { array_def *a=arr_creat(); arr_append(a,w->addrs_num); arr_appends(a,w->ack,380); emit tran_send_signal(w->u.p,0x81,arr_temp(a)); tran_set_busy(w->u.p,0); } } static void write_uid_return_ok(void *p) { write_uid_def *u=p; array_def *a=arr_creat(); arr_append(a,u->addrs_num); for(int i=0;i<10;i++) { arr_append(a,i); arr_append(a,0); arr_append_num(a,36,0); } emit tran_send_signal(u->u.p,0x81,arr_temp(a)); tran_set_busy(u->u.p,0); } static void write_del(ucport_def *u) { free(u); } static ucport_def *write_uid(tran_def *t, uint8_t cmd,array_def *data) { if(arr_length(data)<242){ DBG_WARN("cmd format err."); return 0; } write_uid_def *u=calloc(1,sizeof(write_uid_def)); u->u.p=t; u->u.del=write_del; u->u.doend=write_uid_end; u->addrs_num=arr_get(data,0); memcpy(u->year,arr_data(data)+1,4); // 数据固定140字节,如果不检测某通道,则该通道填充占位符 for(int i=0;i<10;i++) { memcpy(u->uid[i],arr_data(data)+1+i*14,14); } // 默认失败 for(int i=0;i<10;i++) { u->ack[i*38+0]=i; u->ack[i*38+1]=1; } tran_set_busy(t,1); for(int i=0;i<10;i++) { if(1){ port_mcu *mcu=tran_get_portm(u->u.p,i); // 这里打开赋码操作 if(mcu){ //port_start(mcu,code_creat(15,8,&u->uid[i])); } } } array_def *a=arr_creat(); arr_append(a,u->addrs_num); arr_append(a,0); emit tran_reply_signal(u->u.p,arr_temp(a)); // test:稍后返回成功 later_execute(write_uid_return_ok,u,500); return (ucport_def *)u; } transmit_export(ym_checker,0x02,write_uid) typedef struct{ ucport_def u; uint8_t addrs_num; uint8_t type; uint8_t ack[(6)*10]; uint8_t ack_num; void (*doexert)(ucport_def *u); }check_def; // 检测完成 static void check_end(ucport_def *u,port_mcu *src,void *data,int ack,char *err_str) { check_def *w=(check_def *)u; uint8_t addr=port_get_addr(src); if(addr<=0||addr>10){ DBG_WARN("addr err:%d",addr); return; } uint8_t *ack_d=&w->ack[(addr-1)*6]; ack_d[1]=ack; // TODO: 还有4字节数据 w->ack_num++; if(w->ack_num>=10) { array_def *a=arr_creat(); arr_append(a,w->addrs_num); arr_append(a,w->type); arr_appends(a,w->ack,(6)*10); emit tran_send_signal(w->u.p,0x81,arr_temp(a)); tran_set_busy(w->u.p,0); } } static void check_return_ok(void *p) { check_def *u=p; array_def *a=arr_creat(); arr_append(a,u->addrs_num); arr_append(a,u->type); // 固定返回6*10个字节,如果不检测某通道,则该通道填充占位符 for(int i=0;i<10;i++){ arr_append(a,i); arr_append(a,0);// 成功 arr_append_num(a,4,0); } emit tran_send_signal(u->u.p,0x81,arr_temp(a)); tran_set_busy(u->u.p,0); } static void check_del(ucport_def *u) { free(u); } static ucport_def *check(tran_def *t, uint8_t cmd,array_def *data) { if(arr_length(data)<2){ DBG_WARN("cmd format err."); return 0; } check_def *u=calloc(1,sizeof(check_def)); u->u.p=t; u->u.del=check_del; u->u.doend=check_end; u->addrs_num=arr_get(data,0); u->type=arr_get(data,0); // 默认失败 for(int i=0;i<10;i++) { u->ack[i*6+0]=i; u->ack[i*6+1]=1; } tran_set_busy(t,1); for(int i=0;i<10;i++) { if(1){ port_mcu *mcu=tran_get_portm(u->u.p,i); // 这里打开检测 // if(mcu){ // port_start(mcu,check_creat(check_scheme())); // } } } array_def *a=arr_creat(); arr_append(a,u->addrs_num); arr_append(a,u->type); arr_append(a,0); emit tran_reply_signal(u->u.p,arr_temp(a)); // test:稍后返回成功 later_execute(check_return_ok,u,500); return (ucport_def *)u; } transmit_export(ym_checker,0x01,check) typedef struct{ rt_timer_t timer; }live_keeper_def; static void live_connect(live_keeper_def *t) { rt_tick_t tick=0; tick=rt_tick_from_millisecond(1000); rt_timer_control(t->timer,RT_TIMER_CTRL_SET_TIME,&tick); rt_timer_start(t->timer); } static void live_recv(live_keeper_def *t) { rt_tick_t tick=0; tick=rt_tick_from_millisecond(5000); rt_timer_control(t->timer,RT_TIMER_CTRL_SET_TIME,&tick); rt_timer_start(t->timer); } // cmd=0x8a static void live_send(void *p) { const sys_param_def *par=sys_param(); array_def *d=arr_creat(); arr_append(d,0); arr_append(d,0xff); arr_append(d,0x03); arr_append(d,par->local_id&0xff); arr_append(d,0xff);// 在线的小板 arr_append(d,0x03); emit coder2_live_send_signal(p,0x8a,arr_temp(d)); } static void init_for_tcp(void *t) { void *tcp=app_variable("tcp",0,0); void *protu=app_variable("protu",0,0); if(tcp&&protu){ live_keeper_def *live=calloc(1,sizeof(live_keeper_def)); live->timer=rt_timer_create("live_t",live_send,live, rt_tick_from_millisecond(1000), RT_TIMER_FLAG_PERIODIC|RT_TIMER_FLAG_SOFT_TIMER); protu_codec_set(protu,protu_find_codec("ym_coder")); connect(tcp,tcp_connect_signal,0,live,live_connect); connect(tcp,tcp_recv_signal,0,live,live_recv); connect(live,coder2_live_send_signal,0,protu,protu_send_call); }else{ DBG_WARN("can not fond variable \"tcp\" or/and \"protu\""); } } // 如果本机为赋码仪并且连接类型为tcp // 初始化心跳 static int init_live_keeper(void) { const sys_param_def *par=sys_param(); if((strcmp(par->device_type,"coder")==0)&&(strcmp(par->host_if,"utcp")==0)) { app_valid_call("protu",init_for_tcp,0); } return 0; } app_init_export(init_live_keeper);