static private RobotStatus SetPos(RobotAgent robot_agent, object[] args)
{
Pos_T target = new Pos_T();
target.pos = (double[])args[0];
int ret = robot_agent.SetHomePos(target);
RobotStatus robot_status = robot_agent.GetStatus();
robot_status.ret_code = ret;
return(robot_status);
}