本文整理汇总了C++中aris::core::MSG::SetMsgID方法的典型用法代码示例。如果您正苦于以下问题:C++ MSG::SetMsgID方法的具体用法?C++ MSG::SetMsgID怎么用?C++ MSG::SetMsgID使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类aris::core::MSG
的用法示例。
在下文中一共展示了MSG::SetMsgID方法的5个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: On_VS_DataReceived
int On_VS_DataReceived(Aris::Core::CONN *pConn, Aris::Core::MSG &data)
{
cout<<"receive data from visual system"<<endl;
double *map = new double [data.GetLength()/sizeof(double)];
memcpy(map, data.GetDataAddress(), data.GetLength() );
static double currentH[6],nextH[6];
memcpy(nextH,map,sizeof(nextH));
HexIII.MotionPlanWithKinect(currentH,nextH,*Gait_Calculated_From_Map);
memcpy(currentH,nextH,sizeof(nextH));
delete[] map;
for(int j=0;j<GAIT_ADAPTIVEWALK_LEN;j++)
{
for(int i=0;i<GAIT_WIDTH;i++)
{
CGait::GaitAdaptiveWalk[j][i]=-(int)(Gait_Calculated_From_Map[j][i]);
}
}
Aris::Core::MSG controldata;
controldata.SetMsgID(WALKADAPTIVE);
cs.NRT_PostMsg(controldata);
return 0;
}
示例2: On_VS_ConnectionReceived
int On_VS_ConnectionReceived(Aris::Core::CONN *pConn, const char* addr,int port)
{
Aris::Core::MSG msg;
msg.SetMsgID(VS_Connected);
msg.SetLength(sizeof(port));
msg.Copy(&port,sizeof(port));
msg.CopyMore(addr,strlen(addr));
PostMsg(msg);
return 0;
}
示例3: On_CS_DataReceived
int On_CS_DataReceived(Aris::Core::CONN *pConn, Aris::Core::MSG &data)
{
int cmd_id=data.GetMsgID();
Aris::Core::MSG CMD;
CMD.SetMsgID(CS_CMD_Received);
CMD.SetLength(sizeof(int));
CMD.Copy(&cmd_id,sizeof(int));
// if the cmd has data, it should be repost together
CMD.CopyMore(data.GetDataAddress(), data.GetLength());
cout<<"received CMD is "<<cmd_id<<endl;
PostMsg(CMD);
return 0;
}
示例4: tg
//.........这里部分代码省略.........
{
machineData.motorsModes[i]=EOperationMode::OM_CYCLICVEL;
gaitcmd[MapAbsToPhy[i]]=EGAIT::GAIT_STEPUP_MAP;
rt_printf("STEPUP_MAP Command Get in NRT\n" );
}
}
break;
case STEPDOWN:
if(gait.m_gaitState[MapAbsToPhy[0]]== GAIT_STOP)
{
for(int i=0;i<18;i++)
{
machineData.motorsModes[i]=EOperationMode::OM_CYCLICVEL;
gaitcmd[MapAbsToPhy[i]]=EGAIT::GAIT_STEPDOWN_MAP;
rt_printf("STEPDOWN_MAP Command Get in NRT\n" );
}
}
break;
default:
break;
}
gait.RunGait(gaitcmd,machineData);
if(gait.IsGaitFinished())
{
if(CGait::IsMove == true&&CGait::IsMoveEnd == true)
{
CGait::IsMove = false;
CGait::IsMoveEnd = false;
cout<<"MOVE FINISHED!"<<endl;
Vision_Msg visioncmd = Vision_UpperControl;
Aris::Core::MSG visionmsg;
visionmsg.SetMsgID(VS_Capture);
visionmsg.SetLength(sizeof(visioncmd));
visionmsg.Copy(&visioncmd, sizeof(visioncmd));
PostMsg(visionmsg);
}
if(CGait::IsTurn == true&&CGait::IsTurnEnd == true)
{
CGait::IsTurn = false;
CGait::IsTurnEnd = false;
cout<<"TURN FINISHED!"<<endl;
Vision_Msg visioncmd = Vision_UpperControl;
Aris::Core::MSG visionmsg;
visionmsg.SetMsgID(VS_Capture);
visionmsg.SetLength(sizeof(visioncmd));
visionmsg.Copy(&visioncmd, sizeof(visioncmd));
PostMsg(visionmsg);
}
if(CGait::IsBeginDiscoverStart == true && CGait::IsBeginDiscoverEnd == true)
{
cout<<"BEGINDISCOVER FINISHED!"<<endl;
Vision_Msg visioncmd = Vision_StepUp;
Aris::Core::MSG visionmsg;
visionmsg.SetMsgID(VS_Capture);
visionmsg.SetLength(sizeof(visioncmd));
visionmsg.Copy(&visioncmd, sizeof(visioncmd));
PostMsg(visionmsg);
CGait::IsBeginDiscoverStart = false;
CGait::IsBeginDiscoverStart = false;
}
if(CGait::IsEndDiscoverStart == true && CGait::IsEndDiscoverEnd == true)
示例5: OnGetControlCommand
int OnGetControlCommand(MSG &msg)
{
int CommandID;
msg.Paste(&CommandID,sizeof(int));
Aris::Core::MSG data;
switch(CommandID)
{
case 1:
data.SetMsgID(POWEROFF);
cs.NRT_PostMsg(data);
break;
case 2:
data.SetMsgID(STOP);
cs.NRT_PostMsg(data);
break;
case 3:
data.SetMsgID(ENABLE);
cs.NRT_PostMsg(data);
break;
case 4:
data.SetMsgID(RUNNING);
cs.NRT_PostMsg(data);
break;
case 5:
data.SetMsgID(GOHOME_1);
cs.NRT_PostMsg(data);
break;
case 6:
data.SetMsgID(GOHOME_2);
cs.NRT_PostMsg(data);
break;
case 7:
data.SetMsgID(HOME2START_1);
cs.NRT_PostMsg(data);
break;
case 8:
data.SetMsgID(HOME2START_2);
cs.NRT_PostMsg(data);
break;
case 9:
data.SetMsgID(FORWARD);
cs.NRT_PostMsg(data);
break;
case 10:
data.SetMsgID(BACKWARD);
cs.NRT_PostMsg(data);
break;
case 11:
data.SetMsgID(TURNLEFT);
cs.NRT_PostMsg(data);
break;
case 12:
data.SetMsgID(TURNRIGHT);
cs.NRT_PostMsg(data);
break;
case 13:
data.SetMsgID(LEGUP);
cs.NRT_PostMsg(data);
break;
case 14:
{
CGait::IsVisionWalk = true;
Vision_Msg visioncmd = Vision_UpperControl;
Aris::Core::MSG visionmsg;
visionmsg.SetMsgID(VS_Capture);
visionmsg.SetLength(sizeof(visioncmd));
visionmsg.Copy(&visioncmd, sizeof(visioncmd));
PostMsg(visionmsg);
}
break;
case 15:
{
CGait::IsWalkAvoidRegistered = true;
Vision_Msg visioncmd = Walk_Avoid;
Aris::Core::MSG visionmsg;
visionmsg.SetMsgID(VS_Capture);
visionmsg.SetLength(sizeof(visioncmd));
visionmsg.Copy(&visioncmd, sizeof(visioncmd));
PostMsg(visionmsg);
}
break;
default:
cout<<"Do Not Get Validate CMD"<<endl;
break;
}
return CommandID;
}