添加错误代码
This commit is contained in:
@@ -120,7 +120,7 @@
|
||||
<SetRegEntry>
|
||||
<Number>0</Number>
|
||||
<Key>DLGUARM</Key>
|
||||
<Name>7</Name>
|
||||
<Name>d</Name>
|
||||
</SetRegEntry>
|
||||
<SetRegEntry>
|
||||
<Number>0</Number>
|
||||
@@ -157,16 +157,16 @@
|
||||
<MemoryWindow1>
|
||||
<Mm>
|
||||
<WinNumber>1</WinNumber>
|
||||
<SubType>1</SubType>
|
||||
<ItemText>0x100004D8</ItemText>
|
||||
<SubType>0</SubType>
|
||||
<ItemText>errbit</ItemText>
|
||||
<AccSizeX>0</AccSizeX>
|
||||
</Mm>
|
||||
</MemoryWindow1>
|
||||
<MemoryWindow2>
|
||||
<Mm>
|
||||
<WinNumber>2</WinNumber>
|
||||
<SubType>1</SubType>
|
||||
<ItemText>m</ItemText>
|
||||
<SubType>0</SubType>
|
||||
<ItemText>src_data</ItemText>
|
||||
<AccSizeX>0</AccSizeX>
|
||||
</Mm>
|
||||
</MemoryWindow2>
|
||||
@@ -1428,7 +1428,7 @@
|
||||
|
||||
<Group>
|
||||
<GroupName>lwip</GroupName>
|
||||
<tvExp>0</tvExp>
|
||||
<tvExp>1</tvExp>
|
||||
<tvExpOptDlg>0</tvExpOptDlg>
|
||||
<cbSel>0</cbSel>
|
||||
<RteFlg>0</RteFlg>
|
||||
|
@@ -1,5 +1,6 @@
|
||||
|
||||
|
||||
import lupa
|
||||
from lupa import LuaRuntime
|
||||
|
||||
|
||||
class save:
|
||||
@@ -40,5 +41,17 @@ class save:
|
||||
if __name__ == "__main__":
|
||||
sa=save()
|
||||
print(sa.hex2bit(bytes([0xab,0xcd])))
|
||||
|
||||
lua = LuaRuntime(unpack_returned_tuples=True)
|
||||
save_json=lua.eval("function(a) json=a end")
|
||||
with open("file/json.lua",encoding="utf-8") as f:
|
||||
save_json(lua.execute(f.read()))
|
||||
save_prints=lua.eval("function(a) prints=a end")
|
||||
with open("file/prints.lua",encoding="utf-8") as f:
|
||||
save_prints(lua.execute(f.read()))
|
||||
lua.execute("cfg_name=\"file/checker_ye_cfg.json\"\n")
|
||||
lua.execute("check_data={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}\n")
|
||||
with open("file/judge.lua",encoding="utf-8") as f:
|
||||
lua.execute(f.read())
|
||||
# lua_func = lua.eval('function(a, b) return a+b end')
|
||||
# print(lua_func(1,2))
|
||||
|
||||
|
@@ -173,5 +173,5 @@ class port:
|
||||
if __name__ == "__main__":
|
||||
p=port()
|
||||
# 批检仪测试
|
||||
p.open("utcp",0)
|
||||
p.open("com5",115200)
|
||||
p.checker_test(5)
|
||||
|
1869
python/file/json.lua
Normal file
1869
python/file/json.lua
Normal file
File diff suppressed because it is too large
Load Diff
@@ -23,8 +23,13 @@ PLAN_ID=15
|
||||
-- "方案ID不符",211
|
||||
-- "检测项目不足,无法判定",212
|
||||
-- "数据不合规",213
|
||||
|
||||
|
||||
-- 2023.5.11
|
||||
-- 修改脚本适配 雷管厂电解电容来料检测
|
||||
-- 2023.5.12
|
||||
-- 大于启停的时间从检测器异常改为芯片异常
|
||||
-- 2023.5.19
|
||||
-- 扫描uid,超出最大返回时间范围则显示芯片异常
|
||||
-- 添加起爆充能失败的判断,此时返回芯片异常
|
||||
|
||||
|
||||
|
||||
@@ -262,7 +267,7 @@ function JQ_Test_PowerPrapare(task,err_code)
|
||||
return nil
|
||||
else
|
||||
-- 上电正常,排除检测器异常
|
||||
del(err_code,1)
|
||||
-- del(err_code,1)
|
||||
print("检测上电充能")
|
||||
-- 下一步是上电充能
|
||||
return find_index(task["TaskIndex"]+2,1)
|
||||
@@ -300,8 +305,8 @@ function JQ_Test_PowerOn(task,err_code)
|
||||
print("检测电流")
|
||||
return find_index(task["TaskIndex"]+2,3)
|
||||
end
|
||||
---- 排除接触异常
|
||||
--del(err_code,3)
|
||||
---- 排除检测板异常
|
||||
del(err_code,1)
|
||||
print("检测芯片UID")
|
||||
-- 下一步检测芯片
|
||||
return find_index(task["TaskIndex"]+2,4)
|
||||
@@ -319,6 +324,13 @@ function JQ_Test_ScanUID(task,err_code)
|
||||
only(err_code,5)
|
||||
return nil
|
||||
else
|
||||
ret_value=find_return(task["TaskIndex"]+1)
|
||||
-- 最大反馈时间在范围之外,芯片异常
|
||||
if(ret_value[2]<task["TestStandard"][2]["Min"]) or (ret_value[2]>task["TestStandard"][2]["Max"]) then
|
||||
only(err_code,5)
|
||||
return nil
|
||||
end
|
||||
|
||||
print("检测电流")
|
||||
return find_index(task["TaskIndex"]+2,3)
|
||||
--print("读取芯片代码")
|
||||
@@ -416,12 +428,36 @@ function JQ_Test_BaseCurHigh(task,err_code)
|
||||
del(err_code,3)
|
||||
print("检测桥丝和电容")
|
||||
-- 下一步检测桥丝和电容
|
||||
return find_index(task["TaskIndex"]+2,12)
|
||||
return find_index(task["TaskIndex"]+2,11)
|
||||
end
|
||||
end
|
||||
|
||||
|
||||
|
||||
-- 检测充能,失败则电容异常
|
||||
function JQ_Test_ChgEnergy(task,err_code)
|
||||
if(find_ack(task["TaskIndex"]+1,mid(check_data,1,8))==false)then
|
||||
only(err_code,2)
|
||||
return nil
|
||||
else
|
||||
ret_value=find_return(task["TaskIndex"]+1)
|
||||
if((ret_value[1]>task["TestStandard"][1]["Max"]) or (ret_value[1]<task["TestStandard"][1]["Min"])) then
|
||||
only(err_code,2)
|
||||
return nil
|
||||
end
|
||||
if((ret_value[2]>task["TestStandard"][2]["Max"]) or (ret_value[2]<task["TestStandard"][2]["Min"])) then
|
||||
only(err_code,2)
|
||||
return nil
|
||||
end
|
||||
-- 排除电容异常
|
||||
del(err_code,2)
|
||||
print("检测桥丝")
|
||||
-- 下一步检测桥丝
|
||||
return find_index(task["TaskIndex"]+2,12)
|
||||
end
|
||||
end
|
||||
|
||||
|
||||
|
||||
-- 检测电容电压,返回下一个检测任务,nil停止检测
|
||||
function JQ_Test_CheckDAC(task,err_code)
|
||||
@@ -442,24 +478,39 @@ function JQ_Test_CheckDAC(task,err_code)
|
||||
only(err_code,4)
|
||||
return nil
|
||||
else
|
||||
-- 排除桥丝异常
|
||||
ret_value=find_return(task["TaskIndex"]+1)
|
||||
if((ret_value[1]>task["TestStandard"][1]["Max"]) or (ret_value[1]<task["TestStandard"][1]["Min"])) then
|
||||
only(err_code,4)
|
||||
return nil
|
||||
end
|
||||
-- 排除电容异常
|
||||
del(err_code,4)
|
||||
print("检测电容")
|
||||
return find_index(task["TaskIndex"]+2,12)
|
||||
-- 下一步检测起爆
|
||||
return find_index(task["TaskIndex"]+2,20)
|
||||
end
|
||||
end
|
||||
|
||||
|
||||
-- 检测电容电压,返回下一个检测任务,nil停止检测
|
||||
function JQ_Test_CheckDAC2(task,err_code)
|
||||
-- 起爆充能
|
||||
function JQ_Test_BoomEnergy(task,err_code)
|
||||
if(find_ack(task["TaskIndex"]+1,mid(check_data,1,8))==false)then
|
||||
-- 检测电压失败则主电容异常
|
||||
-- 检测电压失败则桥丝或主电容异常
|
||||
print("task failed.task_index=",task["TaskIndex"])
|
||||
only(err_code,2)
|
||||
-- 这里判断上电充能值,如果偏大则桥丝异常,偏小则电容异常
|
||||
-- 充能流程正常,返回第一个值是电压,第二个值是充能时间
|
||||
-- local task_p=find_index(1,1)
|
||||
-- ret_value=find_return(task_p["TaskIndex"]+1)
|
||||
-- if(ret_value[2]>39999) then
|
||||
-- only(err_code,4)
|
||||
-- return nil
|
||||
-- else
|
||||
-- only(err_code,2)
|
||||
-- return nil
|
||||
-- end
|
||||
only(err_code,5)
|
||||
return nil
|
||||
else
|
||||
-- 排除电容异常
|
||||
del(err_code,2)
|
||||
-- 排除芯片异常,密码错误会导致起爆失败
|
||||
del(err_code,5)
|
||||
print("检测完毕")
|
||||
return nil
|
||||
@@ -469,6 +520,8 @@ end
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
-- 定义占位函数,不应该调用
|
||||
function JQ_Test_Empty(task,err_code)
|
||||
print("err function call,task index=",task["TaskIndex"])
|
||||
@@ -479,18 +532,29 @@ end
|
||||
|
||||
-- 这个数组根据方案检测顺序确定
|
||||
tasks_judge_fun={
|
||||
JQ_Test_PowerPrapare,
|
||||
JQ_Test_PowerOn,
|
||||
JQ_Test_ScanUID,
|
||||
JQ_Test_BaseCurLow,
|
||||
JQ_Test_ReadChipID,
|
||||
JQ_Test_Empty,
|
||||
JQ_Test_BaseCurHigh,
|
||||
JQ_Test_Empty,
|
||||
JQ_Test_CheckDAC,
|
||||
JQ_Test_Empty,
|
||||
JQ_Test_Empty,
|
||||
JQ_Test_CheckDAC2
|
||||
JQ_Test_PowerPrapare,--0
|
||||
JQ_Test_PowerOn,--1
|
||||
JQ_Test_ScanUID,--2
|
||||
JQ_Test_BaseCurLow,--3
|
||||
JQ_Test_ReadChipID,--4
|
||||
JQ_Test_Empty,--5
|
||||
JQ_Test_Empty,--6
|
||||
JQ_Test_Empty,--7
|
||||
JQ_Test_BaseCurHigh,--8
|
||||
JQ_Test_Empty,--9
|
||||
JQ_Test_Empty,--10
|
||||
JQ_Test_Empty,--11
|
||||
JQ_Test_Empty,--12
|
||||
JQ_Test_Empty,--13
|
||||
JQ_Test_Empty,--14
|
||||
JQ_Test_Empty,--15
|
||||
JQ_Test_Empty,--16
|
||||
JQ_Test_ChgEnergy,--17 充能统计
|
||||
JQ_Test_Empty,--18
|
||||
JQ_Test_CheckDAC,--19
|
||||
JQ_Test_Empty,--20
|
||||
JQ_Test_Empty,--21
|
||||
JQ_Test_BoomEnergy,--22
|
||||
}
|
||||
|
||||
|
||||
|
84
python/file/prints.lua
Normal file
84
python/file/prints.lua
Normal file
@@ -0,0 +1,84 @@
|
||||
|
||||
|
||||
|
||||
module = {}
|
||||
|
||||
function module:print_t ( t )
|
||||
local print_r_cache={}
|
||||
local function sub_print_r(t,indent)
|
||||
if (print_r_cache[tostring(t)]) then
|
||||
print(indent.."*"..tostring(t))
|
||||
else
|
||||
print_r_cache[tostring(t)]=true
|
||||
if (type(t)=="table") then
|
||||
for pos,val in pairs(t) do
|
||||
if (type(val)=="table") then
|
||||
print(indent.."["..pos.."] => "..tostring(t).." {")
|
||||
sub_print_r(val,indent..string.rep(" ",string.len(pos)+8))
|
||||
print(indent..string.rep(" ",string.len(pos)+6).."}")
|
||||
elseif (type(val)=="string") then
|
||||
print(indent.."["..pos..'] => "'..val..'"')
|
||||
else
|
||||
print(indent.."["..pos.."] => "..tostring(val))
|
||||
end
|
||||
end
|
||||
else
|
||||
print(indent..tostring(t))
|
||||
end
|
||||
end
|
||||
end
|
||||
if (type(t)=="table") then
|
||||
print(tostring(t).." {")
|
||||
sub_print_r(t," ")
|
||||
print("}")
|
||||
else
|
||||
sub_print_r(t," ")
|
||||
end
|
||||
print()
|
||||
end
|
||||
|
||||
|
||||
|
||||
|
||||
function byte_to_hex(byte,size)
|
||||
local str_table="0123456789ABCDEF"
|
||||
local str_ret=""
|
||||
if(size==2) then
|
||||
str_ret=string.char(
|
||||
string.byte( str_table,((byte>>12)&0xf)+1),
|
||||
string.byte( str_table,((byte>>8)&0xf)+1),
|
||||
string.byte( str_table,((byte>>4)&0xf)+1),
|
||||
string.byte(str_table,(byte&0xf)+1))
|
||||
else
|
||||
str_ret=string.char(string.byte(str_table,(byte%256)//16+1),string.byte(str_table,(byte%256)%16+1))
|
||||
end
|
||||
return str_ret
|
||||
end
|
||||
|
||||
-- function byte_to_num(byte)
|
||||
-- local str_ret=""
|
||||
-- while true do
|
||||
|
||||
|
||||
-- 打印数组
|
||||
function module:print_a ( a,size ,fmt)
|
||||
local str=""
|
||||
if(a==nil) then return end
|
||||
if(size==nil) then size=1 end
|
||||
for pos,val in pairs(a) do
|
||||
str=str..byte_to_hex(val,size)..", "
|
||||
end
|
||||
print(str)
|
||||
end
|
||||
|
||||
|
||||
|
||||
function module:__tostring()
|
||||
return "print table package"
|
||||
end
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
return module
|
@@ -147,13 +147,23 @@ def arr_from_int(num:int):
|
||||
def scheme_get_task_range(j:json):
|
||||
t=bytearray()
|
||||
return_count=j["ReturnCount"]
|
||||
t+=arr_from_int(return_count)
|
||||
t+=arr_from_int(j["ExecuteErrCode"])
|
||||
index=0
|
||||
for i in j["TestStandard"]:
|
||||
t+=arr_from_int(i["Max"])
|
||||
t+=arr_from_int(i["Min"])
|
||||
n=return_count-len(j["TestStandard"])
|
||||
if (index<len(j["ResultErrCode"])):
|
||||
t+=arr_from_int(j["ResultErrCode"][index])
|
||||
else:
|
||||
t+=arr_from_int(0)
|
||||
index+=1
|
||||
# 不足16的部分填充为16
|
||||
n=16-len(j["TestStandard"])
|
||||
for i in range(n):
|
||||
t+=arr_from_int(65535)
|
||||
t+=arr_from_int(0)
|
||||
t+=arr_from_int(0)
|
||||
return t
|
||||
|
||||
# 根据方案生成主板用的字节数据
|
||||
@@ -161,11 +171,9 @@ def scheme_to_host(j:json):
|
||||
t=bytearray()
|
||||
t+=arr_from_int(j["PlanID"])
|
||||
t+=arr_from_int(j["TimeOutM"])
|
||||
b=bytearray()
|
||||
t+=arr_from_int(len(j["TaskArray"]))
|
||||
for i in j["TaskArray"]:
|
||||
b+=scheme_get_task_range(i)
|
||||
t+=arr_from_int(len(b)//8)
|
||||
t+=b
|
||||
t+=scheme_get_task_range(i)
|
||||
return t
|
||||
|
||||
|
||||
@@ -433,8 +441,13 @@ if __name__ == "__main__":
|
||||
# u.init("utcp:7777")
|
||||
# u.send_file(0xee,"file/JQ_JCXB_V54.bin")
|
||||
# u.send_file(0xed,"../Objects/checker_gen1_app_20230602.bin")
|
||||
u.cmd=0x31
|
||||
print(u.encode(bytearray()).hex(' '))
|
||||
u.cmd=0x01
|
||||
print(u.encode(bytearray([0x0a,0x00])).hex(' '))
|
||||
# with open("file/EX三码绑定测试2023-06-26.json","rb") as f:
|
||||
# json_obj=json.loads(f.read())
|
||||
# d=scheme_to_byte(json_obj)
|
||||
# # print("len=",len(d),d.hex(","))
|
||||
# d+=scheme_to_host(json_obj)
|
||||
|
||||
|
||||
# 开始检测
|
||||
|
@@ -5,6 +5,7 @@
|
||||
typedef struct{
|
||||
uint32_t max;
|
||||
uint32_t min;
|
||||
uint32_t err;
|
||||
}item_def;
|
||||
|
||||
|
||||
@@ -12,7 +13,8 @@ typedef struct{
|
||||
typedef struct
|
||||
{
|
||||
uint32_t item_num;
|
||||
item_def data[0];
|
||||
uint32_t err;
|
||||
item_def data[16];
|
||||
}task_def;
|
||||
|
||||
|
||||
|
@@ -121,4 +121,9 @@
|
||||
第一次出现下载程序到一半,参数错误重启的情况
|
||||
2023.6.26
|
||||
批检仪完成整个检测流程测试,编写测试脚本,把检测结果保存到csv文件
|
||||
|
||||
2023.6.28
|
||||
修改方案结构体,可以进行错误判断
|
||||
必须按下按键才响应开始检测命令,
|
||||
设备忙时按下按键不会发送请求检测命令
|
||||
电机步数可以配置,默认22000步
|
||||
解决不插网线会导致程序重启的bug
|
||||
|
@@ -74,6 +74,7 @@ typedef struct{
|
||||
int uartbsp;// 串口4的波特率
|
||||
int coder_ret_mode;// 注码指令返回格式
|
||||
int slave_addr_start;// 小板起始地址
|
||||
int moter_max_count;// 电机最大步数
|
||||
}sys_param_def;
|
||||
|
||||
|
||||
@@ -82,6 +83,22 @@ int flash_save_param(sys_param_def *par);
|
||||
const sys_param_def *sys_param(void);
|
||||
|
||||
|
||||
__packed
|
||||
typedef struct{
|
||||
uint32_t max;
|
||||
uint32_t min;
|
||||
uint32_t err;
|
||||
}scheme_range_def;
|
||||
|
||||
|
||||
|
||||
__packed
|
||||
typedef struct
|
||||
{
|
||||
uint32_t item_num;
|
||||
uint32_t err;
|
||||
scheme_range_def range[16];
|
||||
}scheme_task_def;
|
||||
|
||||
// 方案参数
|
||||
__packed
|
||||
@@ -89,12 +106,8 @@ typedef struct{
|
||||
uint8_t slave_data[2048];
|
||||
uint32_t plan_id;
|
||||
uint32_t timeout_m;
|
||||
uint32_t range_num;
|
||||
__packed
|
||||
struct{
|
||||
uint32_t max;
|
||||
uint32_t min;
|
||||
}range[0];
|
||||
uint32_t task_num;
|
||||
scheme_task_def task[0];
|
||||
}scheme_def;
|
||||
|
||||
|
||||
|
@@ -6,7 +6,7 @@
|
||||
|
||||
|
||||
|
||||
#define BUILD_DATE "2023-06-26 10:46:21"
|
||||
#define BUILD_DATE "2023-06-28 18:04:06"
|
||||
#define SOFT_VERSION "0.01"
|
||||
|
||||
|
||||
|
@@ -102,17 +102,24 @@ commend_export(test,test,"cmd test")
|
||||
static int scheme_info(list_def *argv)
|
||||
{
|
||||
const scheme_def *s=check_scheme();
|
||||
const scheme_task_def *t;
|
||||
if(s->plan_id==0xffffffff){
|
||||
cmd_print("scheme is empty.");
|
||||
return -1;
|
||||
}
|
||||
cmd_print("plan id: %d",s->plan_id);
|
||||
cmd_print("timeout_m: %d",s->timeout_m);
|
||||
cmd_print("range num: %d",s->range_num);
|
||||
for(int i=0;i<s->range_num;i++)
|
||||
cmd_print("task num: %d",s->task_num);
|
||||
for(int i=0;i<s->task_num;i++)
|
||||
{
|
||||
cmd_print(" max:%5d, min:%5d %s",s->range[i].max,s->range[i].min,
|
||||
s->range[i].max<s->range[i].min?"err":"ok");
|
||||
t=&s->task[i];
|
||||
cmd_print(" task:%02d err:%02x",i,t->err);
|
||||
for(int j=0;j<t->item_num;j++)
|
||||
{
|
||||
cmd_print(" max:%5d, min:%5d err:%02x %s",t->range[j].max,t->range[j].min,
|
||||
t->err,
|
||||
t->range[j].max<t->range[j].min?"err":"ok");
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
@@ -228,6 +235,7 @@ static void print_sys_param(const sys_param_def *par)
|
||||
cmd_print("uart bsp: %d",par->uartbsp);
|
||||
cmd_print("coder ret mode: %d",par->coder_ret_mode);
|
||||
cmd_print("slave_addr_start: %d",par->slave_addr_start);
|
||||
cmd_print("moter_max_count: %d",par->moter_max_count);
|
||||
}
|
||||
|
||||
|
||||
@@ -265,6 +273,7 @@ static void print_sys_help(void)
|
||||
cmd_print("set uartbsp 115200");
|
||||
cmd_print("set codermode 1/0");
|
||||
cmd_print("set slave_addr_start 1/0");
|
||||
cmd_print("set moter_max_count 0~30000");
|
||||
cmd_print("set save");
|
||||
}
|
||||
|
||||
@@ -387,6 +396,12 @@ static int sys_set(list_def *argv)
|
||||
spar->slave_addr_start=str_atoi(str);
|
||||
cmd_print("slave addr start: %d",spar->slave_addr_start);
|
||||
}
|
||||
else if(strcmp(list_get_str(argv,1),"moter_max_count")==0)
|
||||
{
|
||||
char *str=list_get_str(argv,2);
|
||||
spar->moter_max_count=str_atoi(str);
|
||||
cmd_print("moter_max_count: %d",spar->moter_max_count);
|
||||
}
|
||||
else{
|
||||
cmd_print("unknown cmd for sysset.");
|
||||
print_sys_help();
|
||||
|
@@ -188,7 +188,7 @@ void *realloc(void *p,size_t size)
|
||||
|
||||
|
||||
|
||||
#define MEM_TEMP_PTR_NUM 400
|
||||
#define MEM_TEMP_PTR_NUM 800
|
||||
typedef void (*del_fun_def)(void *t);
|
||||
|
||||
typedef struct{
|
||||
|
@@ -7,6 +7,7 @@
|
||||
#include "prot_uc.h"
|
||||
#include "key.h"
|
||||
#include "mystdlib.h"
|
||||
#include "transmit.h"
|
||||
|
||||
|
||||
|
||||
@@ -16,6 +17,9 @@
|
||||
typedef struct{
|
||||
int inited;
|
||||
int run;
|
||||
int input;
|
||||
int input_lock;
|
||||
void *tran;
|
||||
}self_def;
|
||||
|
||||
|
||||
@@ -26,36 +30,37 @@ static void request_check(void *p);
|
||||
static void key_thread(void *arg)
|
||||
{
|
||||
self_def *s=arg;
|
||||
gpioin_def *in1,*in2,*in3,*in4;
|
||||
int input=0,input_lock=1;
|
||||
gpioin_def *in1;
|
||||
in1=dev_get("gpioin1");
|
||||
in2=dev_get("gpioin2");
|
||||
in3=dev_get("gpioin3");
|
||||
in4=dev_get("gpioin4");
|
||||
in1->init(in1);
|
||||
in2->init(in2);
|
||||
in3->init(in3);
|
||||
in4->init(in4);
|
||||
|
||||
s->input=0;
|
||||
s->input_lock=1;
|
||||
|
||||
while (s->run)
|
||||
{
|
||||
rt_thread_mdelay(20);
|
||||
//input=(in1->state(in1))|(in2->state(in2)<<1)|(in3->state(in3)<<2)|(in4->state(in4)<<3);
|
||||
input=(in1->state(in1));
|
||||
if(input!=input_lock)
|
||||
s->input=(in1->state(in1));
|
||||
if(s->input!=s->input_lock)
|
||||
{
|
||||
DBG_LOG("key=%08X",input);
|
||||
input_lock=input;
|
||||
if((input&1)==0)
|
||||
DBG_LOG("key=%08X",s->input);
|
||||
s->input_lock=s->input;
|
||||
if((s->input&1)==0)
|
||||
{
|
||||
request_check(s);
|
||||
// 主机交互存在且非忙的时候才发送请求
|
||||
if(s->tran&&(tran_get_busy(s->tran)==0))
|
||||
request_check(s);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
|
||||
// 获取实时按键状态,1按下
|
||||
int key_pressed(void)
|
||||
{
|
||||
self_def *s=&g_self;
|
||||
return !s->input;
|
||||
}
|
||||
|
||||
|
||||
// cmd=0x37
|
||||
@@ -81,7 +86,11 @@ static void init_later(void *t)
|
||||
DBG_WARN("can not fond variable \"protu\"");
|
||||
}
|
||||
}
|
||||
|
||||
static void init_tran(void *t)
|
||||
{
|
||||
self_def *s=t;
|
||||
s->tran=app_variable("tran",0,0);
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -95,6 +104,7 @@ static int init_thread(void)
|
||||
rt_thread_t rt_t=rt_thread_create("key_t",key_thread,s,1024,15,20);
|
||||
rt_thread_startup(rt_t);
|
||||
app_valid_call("protu",init_later,s);
|
||||
app_valid_call("tran",init_tran,s);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
@@ -16,6 +16,7 @@ signal key_send_signal(void *obj,uint8_t cmd,array_def *data);
|
||||
|
||||
|
||||
|
||||
int key_pressed(void);
|
||||
|
||||
|
||||
|
||||
|
@@ -64,10 +64,11 @@ static void log_thread(void *arg)
|
||||
else
|
||||
{
|
||||
DBG_LOG("udp:err=%d",err);
|
||||
//netconn_close(conn);
|
||||
//netconn_delete(conn);
|
||||
rt_thread_mdelay(1000);
|
||||
}
|
||||
}
|
||||
netconn_close(conn);
|
||||
netconn_delete(conn);
|
||||
}
|
||||
|
||||
|
||||
|
@@ -96,7 +96,7 @@ void moter_down(void (*fun)(void *t),void *t)
|
||||
s->fun_in_end=fun;
|
||||
s->t=t;
|
||||
}
|
||||
moter_start(0,MOTER_MAX_COUNT-s->count);
|
||||
moter_start(0,s->max_count-s->count);
|
||||
}
|
||||
|
||||
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD>ص<EFBFBD>
|
||||
@@ -177,8 +177,13 @@ int init_moter(void)
|
||||
pwm->set_irq_fun(pwm,end_irq,s);
|
||||
s->pwm=pwm;
|
||||
s->stat=INITING;
|
||||
s->count=MOTER_MAX_COUNT;
|
||||
s->max_count=MOTER_MAX_COUNT;
|
||||
if((par->moter_max_count>25000)||(par->moter_max_count<1000))
|
||||
{
|
||||
s->max_count=MOTER_MAX_COUNT;
|
||||
}else{
|
||||
s->max_count=par->moter_max_count;
|
||||
}
|
||||
s->count=s->max_count;
|
||||
s->event=rt_event_create("moter_e",RT_IPC_FLAG_FIFO);
|
||||
s->inited=1;
|
||||
s->run=1;
|
||||
|
@@ -10,7 +10,7 @@
|
||||
#include "compiler_info.h"
|
||||
#include "dev_backup.h"
|
||||
#include "moter.h"
|
||||
|
||||
#include "key.h"
|
||||
|
||||
|
||||
|
||||
@@ -25,24 +25,43 @@ typedef struct{
|
||||
}check_def;
|
||||
|
||||
|
||||
|
||||
// 计算方案有多少个范围参数
|
||||
static int calc_range_num(void)
|
||||
{
|
||||
const scheme_def *s=check_scheme();
|
||||
const scheme_task_def *t;
|
||||
int index=0;
|
||||
for(int i=0;i<s->task_num;i++)
|
||||
{
|
||||
t=&s->task[i];
|
||||
index+=t->item_num;
|
||||
}
|
||||
return index;
|
||||
}
|
||||
|
||||
// 判断检测数据是否超限,返回填充的字节个数
|
||||
static int in_range(const uint8_t *src_data,uint8_t *range)
|
||||
{
|
||||
const scheme_def *s=check_scheme();
|
||||
const scheme_task_def *t;
|
||||
int temp;
|
||||
for(int i=0;i<s->range_num;i++)
|
||||
int index=0;
|
||||
for(int i=0;i<s->task_num;i++)
|
||||
{
|
||||
temp=src_data[i*2]|(src_data[i*2+1]<<8);
|
||||
if(temp>=s->range[i].min&&temp<=s->range[i].max){
|
||||
range[i/8]&=~(1<<(i%8));
|
||||
}else{
|
||||
range[i/8]|=(1<<(i%8));
|
||||
t=&s->task[i];
|
||||
for(int j=0;j<t->item_num;j++)
|
||||
{
|
||||
temp=src_data[index*2]|(src_data[index*2+1]<<8);
|
||||
if(temp>=t->range[j].min&&temp<=t->range[j].max){
|
||||
range[index/8]&=~(1<<(index%8));
|
||||
}else{
|
||||
range[index/8]|=(1<<(index%8));
|
||||
}
|
||||
index++;
|
||||
}
|
||||
}
|
||||
DBG_LOG("range_num=%d, ",s->range_num);
|
||||
return (s->range_num+7)/8;
|
||||
DBG_LOG("range_num=%d, ",index);
|
||||
return (index+7)/8;
|
||||
}
|
||||
|
||||
|
||||
@@ -68,7 +87,7 @@ static void check_end(ucport_def *u,port_mcu *src,void *data,int ack,char *err_s
|
||||
// 返回参数校验,跳过8字节的流程执行位
|
||||
ack_d+=in_range(arr_data(data)+8+8,ack_d);
|
||||
// 复制返回参数,跳过8字节的流程执行位
|
||||
memcpy(ack_d,arr_data(data)+8+8,check_scheme()->range_num*2);
|
||||
memcpy(ack_d,arr_data(data)+8+8,calc_range_num()*2);
|
||||
}
|
||||
else
|
||||
{
|
||||
@@ -131,7 +150,7 @@ static void check_when_moter_down(void *t)
|
||||
|
||||
static ucport_def *check(tran_def *t, uint8_t cmd,array_def *data)
|
||||
{
|
||||
int return_size=(check_scheme()->range_num*2+8+(check_scheme()->range_num+7)/8);
|
||||
int return_size=(calc_range_num()*2+8+(calc_range_num()+7)/8);
|
||||
check_def *u=calloc(1,sizeof(check_def)+return_size*20);
|
||||
u->ret_skip=return_size;
|
||||
u->ack_size=return_size*20;
|
||||
@@ -140,10 +159,15 @@ static ucport_def *check(tran_def *t, uint8_t cmd,array_def *data)
|
||||
u->u.dolater=check_dolater;
|
||||
u->u.doend=check_end;
|
||||
DBG_LOG("check: skip=%d",u->ret_skip);
|
||||
tran_set_busy(t,1);
|
||||
moter_down(check_when_moter_down,u);
|
||||
array_def *a=arr_creat();
|
||||
arr_append(a,0);
|
||||
if(key_pressed())
|
||||
{
|
||||
tran_set_busy(t,1);
|
||||
moter_down(check_when_moter_down,u);
|
||||
arr_append(a,TRAN_ERR_NONE);
|
||||
}else{
|
||||
arr_append(a,TRAN_ERR_STEP);
|
||||
}
|
||||
emit tran_reply_signal(u->u.p,arr_temp(a));
|
||||
|
||||
return (ucport_def *)u;
|
||||
|
@@ -17,6 +17,13 @@
|
||||
|
||||
|
||||
|
||||
typedef struct{
|
||||
int step;// 检测注码顺序
|
||||
}self_def;
|
||||
|
||||
static self_def g_self;
|
||||
|
||||
|
||||
// 从机地址偏移
|
||||
static inline int slave_addr_off(void)
|
||||
{
|
||||
@@ -85,6 +92,7 @@ static void write_uid_end(ucport_def *u,port_mcu *src,void *data,int ack,char *e
|
||||
}
|
||||
emit tran_send_signal(w->u.p,0x82,arr_temp(a));
|
||||
tran_set_busy(w->u.p,0);
|
||||
g_self.step=0;
|
||||
}
|
||||
}
|
||||
|
||||
@@ -105,6 +113,7 @@ static void write_uid_return_ok(void *p)
|
||||
}
|
||||
emit tran_send_signal(u->u.p,0x82,arr_temp(a));
|
||||
tran_set_busy(u->u.p,0);
|
||||
g_self.step=0;
|
||||
}
|
||||
|
||||
|
||||
@@ -120,6 +129,7 @@ static ucport_def *write_uid(tran_def *t, uint8_t cmd,array_def *data)
|
||||
DBG_WARN("cmd format err.");
|
||||
return 0;
|
||||
}
|
||||
int ret=0;
|
||||
write_uid_def *u=calloc(1,sizeof(write_uid_def));
|
||||
u->u.p=t;
|
||||
u->u.del=write_del;
|
||||
@@ -135,10 +145,10 @@ static ucport_def *write_uid(tran_def *t, uint8_t cmd,array_def *data)
|
||||
memcpy(u->item[i].shell_code,d_off+i*14+1,13);
|
||||
DBG_LOG("slave:%d, shell=%s",i,u->item[i].shell_code);
|
||||
// 生成uid码
|
||||
coder_shell_to_uid(u->year,u->item[i].shell_code,u->item[i].uid_code);
|
||||
ret|=coder_shell_to_uid(u->year,u->item[i].shell_code,u->item[i].uid_code);
|
||||
DBG_LOG("slave:%d, uid=%s",i,u->item[i].uid_code);
|
||||
// 生成存储码
|
||||
coder_uid_to_save(u->item[i].uid_code,u->item[i].uid_pw_hex);
|
||||
ret|=coder_uid_to_save(u->item[i].uid_code,u->item[i].uid_pw_hex);
|
||||
// 生成密码
|
||||
GetPasswordByUidCode((uint8_t *)u->item[i].uid_code,&u->item[i].uid_pw_hex[8]);
|
||||
d_=u->item[i].uid_pw_hex;
|
||||
@@ -155,6 +165,8 @@ static ucport_def *write_uid(tran_def *t, uint8_t cmd,array_def *data)
|
||||
u->ack[i*39+0]=i+slave_addr_off();
|
||||
u->ack[i*39+1]=1;
|
||||
}
|
||||
|
||||
|
||||
tran_set_busy(t,1);
|
||||
for(int i=0;i<10;i++)
|
||||
{
|
||||
@@ -169,7 +181,14 @@ static ucport_def *write_uid(tran_def *t, uint8_t cmd,array_def *data)
|
||||
|
||||
array_def *a=arr_creat();
|
||||
arr_append(a,u->addrs_num);
|
||||
arr_append(a,0);
|
||||
if(g_self.step==1){
|
||||
if(ret==0)
|
||||
arr_append(a,TRAN_ERR_NONE);
|
||||
else
|
||||
arr_append(a,TRAN_ERR_PARAM);
|
||||
}else{
|
||||
arr_append(a,TRAN_ERR_STEP);
|
||||
}
|
||||
emit tran_reply_signal(u->u.p,arr_temp(a));
|
||||
|
||||
// test:稍后返回成功
|
||||
@@ -236,6 +255,45 @@ transmit_export(ym_checker,0x03,write_uid2)
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
// 判断检测数据错误码
|
||||
// 返回 errcode,1=param/0=execute,taskindex,paramindex
|
||||
static uint32_t in_range_err(const uint8_t *src_data,const uint8_t *errbit)
|
||||
{
|
||||
const scheme_def *s=check_scheme();
|
||||
const scheme_task_def *t;
|
||||
int temp;
|
||||
int index=0;
|
||||
uint32_t ret=0;
|
||||
for(int i=0;i<s->task_num;i++)
|
||||
{
|
||||
t=&s->task[i];
|
||||
if((errbit[i/8]&(1<<(i%8)))!=0)
|
||||
{
|
||||
ret=(t->err&0xff)|(i<<16);
|
||||
return ret;
|
||||
}
|
||||
for(int j=0;j<t->item_num;j++)
|
||||
{
|
||||
temp=src_data[index*2]|(src_data[index*2+1]<<8);
|
||||
if(temp>=t->range[j].min&&temp<=t->range[j].max){
|
||||
// 正常
|
||||
}else{
|
||||
ret=(t->range[j].err&0xff)|(1<<8)|(i<<16)|(j<<24);
|
||||
return ret;
|
||||
}
|
||||
index++;
|
||||
}
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
typedef struct{
|
||||
ucport_def u;
|
||||
uint8_t addrs_num;
|
||||
@@ -258,10 +316,16 @@ static void check_end(ucport_def *u,port_mcu *src,void *data,int ack,char *err_s
|
||||
}
|
||||
addr-=1;
|
||||
|
||||
uint32_t errcode=0;
|
||||
uint8_t *ack_d=&w->ack[(addr)*6];
|
||||
ack_d[0]=addr+slave_addr_off();
|
||||
ack_d[1]=ack;
|
||||
// TODO: 还有4字节数据
|
||||
errcode=in_range_err(arr_data(data)+8+8,arr_data(data));
|
||||
ack_d[2]=errcode&0xff;
|
||||
ack_d[3]=(errcode>>8)&0xff;
|
||||
ack_d[4]=(errcode>>16)&0xff;
|
||||
ack_d[5]=(errcode>>24)&0xff;
|
||||
|
||||
w->ack_num++;
|
||||
if(w->ack_num>=10)
|
||||
@@ -272,6 +336,7 @@ static void check_end(ucport_def *u,port_mcu *src,void *data,int ack,char *err_s
|
||||
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);
|
||||
g_self.step=1;
|
||||
}
|
||||
}
|
||||
|
||||
@@ -292,6 +357,7 @@ static void check_return_ok(void *p)
|
||||
}
|
||||
emit tran_send_signal(u->u.p,0x81,arr_temp(a));
|
||||
tran_set_busy(u->u.p,0);
|
||||
g_self.step=1;
|
||||
}
|
||||
|
||||
|
||||
@@ -335,7 +401,7 @@ static ucport_def *check(tran_def *t, uint8_t cmd,array_def *data)
|
||||
array_def *a=arr_creat();
|
||||
arr_append(a,u->addrs_num);
|
||||
arr_append(a,u->type);
|
||||
arr_append(a,0);
|
||||
arr_append(a,TRAN_ERR_NONE);
|
||||
emit tran_reply_signal(u->u.p,arr_temp(a));
|
||||
|
||||
// test:稍后返回成功
|
||||
|
@@ -116,6 +116,9 @@ void tran_recv_slot(tran_def *t,const char *codec_name,uint8_t cmd,array_def *da
|
||||
DBG_LOG("tran init");
|
||||
if(tran_get_busy(tr)){
|
||||
DBG_WARN("ucport is busy.");
|
||||
array_def *d=arr_creat();
|
||||
arr_append(d,TRAN_ERR_BUSY);
|
||||
emit tran_send_signal(tr,cmd,arr_temp(d));
|
||||
return;
|
||||
}
|
||||
CHECK_DO(tr->u,tr->u->del);
|
||||
|
@@ -5,6 +5,18 @@
|
||||
#include "handle.h"
|
||||
#include "signal.h"
|
||||
|
||||
|
||||
|
||||
// 错误码定义
|
||||
#define TRAN_ERR_NONE 0x00
|
||||
#define TRAN_ERR_BUSY 0x01
|
||||
#define TRAN_ERR_PARAM 0x02
|
||||
#define TRAN_ERR_STEP 0x03
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
struct _tran_def;
|
||||
typedef struct _tran_def tran_def;
|
||||
|
||||
|
Reference in New Issue
Block a user