89 lines
1.7 KiB
C++
89 lines
1.7 KiB
C++
|
#include "prot_m4.h"
|
||
|
|
#include "QDebug"
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
void prot_m4::init()
|
||
|
|
{
|
||
|
|
if_=interFaceFind("uart_m4");
|
||
|
|
codec_=codecFind("codec_m4");
|
||
|
|
|
||
|
|
if_->set_irq([=](myarray recv){
|
||
|
|
if(codec_->packCheck(recv_data)==true){
|
||
|
|
int cmd,src,dst;
|
||
|
|
myarray data=codec_->decode(src,dst,cmd,recv_data);
|
||
|
|
if(exe_cb_fun(data)==false){
|
||
|
|
qWarning("can not find cb fun with:\"%s\"",data);
|
||
|
|
}
|
||
|
|
recv_data.clear();
|
||
|
|
}
|
||
|
|
});
|
||
|
|
}
|
||
|
|
|
||
|
|
void prot_m4::send_data_slot(myarray data)
|
||
|
|
{
|
||
|
|
if((if_!=nullptr)&&(codec_!=nullptr)){
|
||
|
|
myarray send=codec_->encode(0,0,0,data);
|
||
|
|
if_->write(send);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
bool prot_m4::exe_cb_fun(myarray data)
|
||
|
|
{
|
||
|
|
int left;
|
||
|
|
for (int i=0;i<funs.size();i++){
|
||
|
|
left=funs[i].cmd.size();
|
||
|
|
if(data.left(left)==funs[i].cmd){
|
||
|
|
if(funs[i].fun!=nullptr){
|
||
|
|
funs[i].fun(myarray(data.mid(left)));
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return false;
|
||
|
|
}
|
||
|
|
|
||
|
|
static prot_m4 *g_protm4;
|
||
|
|
prot_m4 *protM4(){
|
||
|
|
if(g_protm4==nullptr){
|
||
|
|
g_protm4=new prot_m4();
|
||
|
|
g_protm4->init();
|
||
|
|
}
|
||
|
|
return g_protm4;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
bool prot_m4::set_irq_fun(prot_m4_cb fun,myarray data)
|
||
|
|
{
|
||
|
|
int left;
|
||
|
|
for (int i=0;i<funs.size();i++){
|
||
|
|
left=funs[i].cmd.size();
|
||
|
|
if(data.left(left)==funs[i].cmd){
|
||
|
|
return false;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
HandleM4_def m4_cmd;
|
||
|
|
m4_cmd.cmd=data;
|
||
|
|
m4_cmd.fun=fun;
|
||
|
|
funs.append(m4_cmd);
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
bool prot_m4::del_irq_fun(prot_m4_cb fun,myarray data)
|
||
|
|
{
|
||
|
|
int left;
|
||
|
|
for (int i=0;i<funs.size();i++){
|
||
|
|
left=funs[i].cmd.size();
|
||
|
|
if(data.left(left)==funs[i].cmd){
|
||
|
|
funs.removeAt(i);
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return false;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
|