#include "tran_for_coder.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; uint16_t addrs; uint8_t uid_password[240]; uint8_t ack[10]; 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,0); arr_append(a,w->addrs&0xff); arr_append(a,w->addrs>>8); arr_appends(a,w->ack,10); 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,0); arr_append(a,u->addrs&0xff); arr_append(a,u->addrs>>8); arr_append_num(a,10,0); emit tran_send_signal(u->u.p,0x81,arr_temp(a)); tran_set_busy(u->u.p,0); } 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.doend=write_uid_end; u->addrs=arr_get(data,0)|(arr_get(data,1)<<8); // 数据固定240字节,如果不检测某通道,则该通道填充占位符 memcpy(u->uid_password,arr_data(data)+2,240); // 默认失败 memset(u->ack,1,10); tran_set_busy(t,1); for(int i=0;i<10;i++) { if(u->addrs&(1<u.p,i); // 这里打开赋码操作 if(mcu){ port_start(mcu,code_creat(15,8,&u->uid_password[i*24])); } } } array_def *a=arr_creat(); arr_append(a,0); arr_append(a,u->addrs&0xff); arr_append(a,u->addrs>>8); 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_coder,0x01,write_uid) typedef struct{ ucport_def u; uint16_t addrs; uint8_t data[5]; uint8_t ack[(4+3)*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)*7]; ack_d[2]=ack; // TODO: 还有4字节数据 w->ack_num++; if(w->ack_num>=10) { array_def *a=arr_creat(); arr_append(a,0); arr_append(a,w->addrs&0xff); arr_append(a,w->addrs>>8); arr_appends(a,w->ack,(4+3)*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,0); arr_append(a,u->addrs&0xff); arr_append(a,u->addrs>>8); // 固定返回7*10个字节,如果不检测某通道,则该通道填充占位符 for(int i=0;i<10;i++){ arr_append(a,i+1); arr_append(a,u->data[0]); arr_append(a,0); arr_append_num(a,4,0); } emit tran_send_signal(u->u.p,0x85,arr_temp(a)); tran_set_busy(u->u.p,0); } static ucport_def *check(tran_def *t, uint8_t cmd,array_def *data) { if(arr_length(data)<7){ DBG_WARN("cmd format err."); return 0; } check_def *u=calloc(1,sizeof(check_def)); u->u.p=t; u->u.doend=check_end; u->addrs=arr_get(data,0)|(arr_get(data,1)<<8); memcpy(u->data,arr_data(data)+2,5); // 默认失败 for(int i=0;i<10;i++) { u->ack[i*7+0]=i+1; u->ack[i*7+1]=u->data[0]; u->ack[i*7+2]=1; } tran_set_busy(t,1); for(int i=0;i<10;i++) { if(u->addrs&(1<u.p,i); // 这里打开检测 if(mcu){ port_start(mcu,check_creat(check_scheme())); } } } array_def *a=arr_creat(); arr_append(a,0); arr_append(a,u->addrs&0xff); arr_append(a,u->addrs>>8); arr_append(a,u->data[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_coder,0x05,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=9x8a 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 coder_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,coder_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);