checker_gen1/source/task/handle_for_checker.c

#include "handle.h"
#include "mystdlib.h"
#include "board.h"
#include "debug.h"
#include "transmit.h"
#include "commend.h"
#include "handle_for_checker.h"
#include "mystring.h"






static void bootinfo_start(handle_def *h)
{
  port_set_busy(h->p,1);
  list_def *l=list_creat_int();
  int cmds[]={0x13};
  list_appends(l,cmds,1);
  l=list_temp(l);
  array_def *a=arr_temp(arr_creat());
  emit port_send_signal(h->p,port_get_addr(h->p),0x13,l,a,60,5);
}


static bootinfo_data *bootinfo_decode(array_def *data);
static void bootinfo_dolater(handle_def *h,uint8_t src,uint8_t cmd,array_def *data,char *err_str)
{
  if(port_get_busy(h->p)==0) return;
  port_set_busy(h->p,0);
  //DBG_LOG("slave:%d, bootinfo recv",h->p->addr);
  port_timer_stop(h->p);
  if(arr_get(data,0)==0)
  {
    DBG_LOG("slave:%d, success",port_get_addr(h->p));
    arr_remove(data,0,1);
    emit port_end_signal(h->p,h->p,tappend(bootinfo_decode(data),0),0,"ok");
  }
  else{
    emit port_end_signal(h->p,h->p,0,-1,"slave return err");
  }
}


static bootinfo_data *bootinfo_decode(array_def *data)
{
  param_check(arr_length(data)>=24);
  bootinfo_data *d=calloc(1,sizeof(bootinfo_data));
  param_check(d);
  d->app_state=arr_get(data,0);
  d->slaver_addr=arr_get(data,1);
  d->chip_tmper=(arr_get(data,2)|(arr_get(data,3)<<8));
  d->ad_2v5=(arr_get(data,4)|(arr_get(data,5)<<8));
  d->ad_1v25=(arr_get(data,6)|(arr_get(data,7)<<8));
  d->ad_wave=(arr_get(data,8)|(arr_get(data,9)<<8));
  d->ad_5v5_just=(arr_get(data,10)|(arr_get(data,11)<<8));
  d->ad_26v_just=(arr_get(data,12)|(arr_get(data,13)<<8));
  d->hard_version=(arr_get(data,14)|(arr_get(data,15)<<8));
  d->soft_version=(arr_get(data,16)|(arr_get(data,17)<<8));
  d->res_just=arr_get(data,18)|(arr_get(data,19)<<8);
  d->scheme_id=arr_get(data,20)|(arr_get(data,21)<<8)|(arr_get(data,22)<<16)|(arr_get(data,23)<<24);
  DBG_LOG("\r\n"
    " slave=%d,bootinfo:\r\n"
    "      chip_tmper=%d\r\n"
    "      ad_2v5=%d\r\n"
    "      ad_1v25=%d\r\n"
    "      ad_wave=%d\r\n"
    "      ad_5v5_just=%d\r\n"
    "      ad_26v_just=%d\r\n"
    "      hard_version=%d\r\n"
    "      soft_version=%d\r\n"
    "      res_just=%d\r\n"
    "      scheme_id=%d\r\n"
    ,
    d->slaver_addr,d->chip_tmper,d->ad_2v5,d->ad_1v25,d->ad_wave,d->ad_5v5_just,
    d->ad_26v_just,d->hard_version,d->soft_version,d->res_just,d->scheme_id
    );
  return d;
}

static void bootinfo_timeout(handle_def *h)
{
  // 从机没有指定数目时从这里返回
  port_timer_stop(h->p);
  port_set_busy(h->p,0);
  DBG_WARN("slave:%d,%s timeout.",port_get_addr(h->p), h->name);
  emit port_end_signal(h->p,h->p,0,-1,"timeout");
}



handle_def *bootinfo_creat(void)
{
  handle_def *h=calloc(1,sizeof(handle_def));
  param_check(h);
  h->static_=0;// 动态内存这项设置为0
  h->start=bootinfo_start;
  h->dolater=bootinfo_dolater;
  h->del=(void (*)(handle_def *))free;
  h->timeout=bootinfo_timeout;
  h->interval=3000;
  h->name="bootinfo";
  return h;
}














typedef struct{
  handle_def h;
  const scheme_def *sch;
  rt_timer_t timer;// 用于重复发送获取数据的命令
}check_def;



static void check_start(handle_def *h)
{
  port_set_busy(h->p,1);
  list_def *l=list_creat_int();
  int arr[]={0x0c,0x16};
  list_appends(l,arr,2);
  emit port_send_signal(h->p,port_get_addr(h->p),0x0c,list_temp(l),arr_temp(arr_creat()),60,0);
}


static void check_dolater(handle_def *h,uint8_t src,uint8_t cmd,array_def *data,char *err_str)
{
  check_def *c=(check_def *)h;
  if(port_get_busy(h->p)==0) return;
  if(cmd==0x02)
  {
    if(arr_get(data,0)==0)
    {
      port_set_busy(h->p,0);
      port_timer_stop(h->p);
      DBG_LOG("slave:%d, recv check data",src);
      arr_remove(data,0,1);
      DBG_LOG("slave:%d, recv:%s",src,str_temp(arr_string(data)));
      //emit port_end_signal(h->p,h->p,tappend(scheme_check_returns(c->sch,data),0),0,"ok");
      // 直接返回原始数据
      emit port_end_signal(h->p,h->p,data,0,"ok");
    }else if(arr_get(data,0)==2){
      // 检测中则继续发送
      list_def *l=list_creat_int();
      int arr[]={0x02};
      list_appends(l,arr,1);
      emit port_send_signal(h->p,port_get_addr(h->p),0x02,list_temp(l),arr_temp(arr_creat()),60,130);
    }
    else{
      port_set_busy(h->p,0);
      port_timer_stop(h->p);
      DBG_WARN("slave:%d,get check_result err,%s",src,str_temp(arr_string(data)));
      emit port_end_signal(h->p,h->p,0,arr_get(data,0),"get check_result err");
    }
  }
  else if(cmd==0x0c)
  {
    if(arr_get(data,0)==0)
    {
      int timeout =h->interval;
      DBG_LOG("slave:%d, check first ack,timeout=%d",src,timeout);
      list_def *l=list_creat_int();
      int arr[]={0x02};
      list_appends(l,arr,1);
      emit port_send_signal(h->p,port_get_addr(h->p),0x02,list_temp(l),arr_temp(arr_creat()),60,timeout/60);
    }
    else{
      port_set_busy(h->p,0);
      port_timer_stop(h->p);
      DBG_WARN("slave:%d,get start_check err,%s",src,str_temp(arr_string(data)));
      emit port_end_signal(h->p,h->p,0,-1,"get start_check err");
    }
  }
}


static void check_timeout(handle_def *h)
{
  // 从机没有指定数目时从这里返回
  port_timer_stop(h->p);
  port_set_busy(h->p,0);
  DBG_WARN("slave:%d,%s timeout.",port_get_addr(h->p), h->name);
  emit port_end_signal(h->p,h->p,0,-1,"timeout");
}


static void check_del(handle_def *h)
{
  check_def *c=(check_def *)h;
  CHECK_DO(c->timer,rt_timer_delete);
  free(h);
}


handle_def *check_creat(const scheme_def *sch)
{
  check_def *c=calloc(1,sizeof(check_def));
  handle_def *h=(handle_def *)c;
  param_check(h);
  h->static_=0;// 动态内存这项设置为0
  h->start=check_start;
  h->dolater=check_dolater;
  h->del=check_del;
  h->timeout=check_timeout;
  h->interval=sch->timeout_m*1000;// 此项根据方案调整
  h->name="check";
  c->sch=sch;
  DBG_LOG("check created,timeout=%d",h->interval);
  return h;
}



















static int bootinfo(list_def *argv)
{
  tran_def *tran=app_variable("tran",0,0);
  if(tran==0){
    DBG_WARN("can not fond variable \"tran\"");
    return -1;
  }
  if(list_length(argv)<2){
    cmd_print("param num too less.");
    return -1;
  }
  list_def *addrs=str_atod_list(list_get_str(argv,1),',');
  for(int i=0;i<list_length(addrs);i++)
  {
    int addr=list_get_int(addrs,i);
    port_mcu *mcu=tran_get_portm(tran,addr-1);
    if(mcu)
      port_start(mcu,bootinfo_creat());
  }
  cmd_print("get bootinfo,addr=%s",str_temp(list_string(addrs)));
  return 0;
}


commend_export(bootinfo,bootinfo,"get slave bootinfo")




static int check(list_def *argv)
{
  tran_def *tran=app_variable("tran",0,0);
  if(tran==0){
    DBG_WARN("can not fond variable \"tran\"");
    return -1;
  }
  if(list_length(argv)<2){
    cmd_print("param num too less.");
    return -1;
  }
  list_def *addrs=str_atod_list(list_get_str(argv,1),',');
  for(int i=0;i<list_length(addrs);i++)
  {
    int addr=list_get_int(addrs,i);
    port_mcu *mcu=tran_get_portm(tran,addr-1);
    if(mcu){
      port_start(mcu,check_creat(check_scheme()));
    }
  }
  cmd_print("start check,addr=%s",str_temp(list_string(addrs)));
  return 0;
}


commend_export(check,check,"start electrical check")






static int usercmd(list_def *argv)
{
  tran_def *tran=app_variable("tran",0,0);
  if(tran==0){
    DBG_WARN("can not fond variable \"tran\"");
    return -1;
  }
  if(list_length(argv)<3){
    cmd_print("param num too less.");
    return -1;
  }
  list_def *addrs=str_atod_list(list_get_str(argv,1),',');
  uint8_t cmd=str_atoi(list_get_str(argv,2));
  array_def *data=arr_temp(arr_creat());
  if(list_length(argv)>=4){
    list_def *dat=str_atod_list(list_get_str(argv,3),',');
    for(int i=0;i<list_length(dat);i++){
      arr_append(data,list_get_int(dat,i));
    }
  }
  for(int i=0;i<list_length(addrs);i++)
  {
    int addr=list_get_int(addrs,i);
    port_mcu *mcu=tran_get_portm(tran,addr-1);
    if(mcu)
      port_start(mcu,usercmd_creat(cmd,data));
  }
  cmd_print("start usercmd,addr=%s,cmd=%02x",str_temp(list_string(addrs)),cmd);
  if(arr_length(data)>0){
    cmd_print("data=%s",str_temp(arr_string(data)));
  }
  return 0;
}


commend_export(usercmd,usercmd,"send usercmd to slave|use:usercmd [addrs] [cmd] [datas]")