|
|
@ -43,7 +43,6 @@ struct RobotImp {
|
|
|
|
SETTING_SDK_CONNECTION,
|
|
|
|
SETTING_SDK_CONNECTION,
|
|
|
|
CONNECTING_TO_DEVICE_PORT,
|
|
|
|
CONNECTING_TO_DEVICE_PORT,
|
|
|
|
SETTING_SDK_MODE,
|
|
|
|
SETTING_SDK_MODE,
|
|
|
|
STREAMING_ENABLED,
|
|
|
|
|
|
|
|
RESETTING_SUBNODE,
|
|
|
|
RESETTING_SUBNODE,
|
|
|
|
SUSBCRIBING_SUBNODE,
|
|
|
|
SUSBCRIBING_SUBNODE,
|
|
|
|
SETTING_MOVEMENT_MODE,
|
|
|
|
SETTING_MOVEMENT_MODE,
|
|
|
@ -236,16 +235,6 @@ robot_work(Robot robot) {
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
case STREAMING_ENABLED:
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
vision_enable (
|
|
|
|
|
|
|
|
&req, robot->seq++, true
|
|
|
|
|
|
|
|
);
|
|
|
|
|
|
|
|
req_send(robot->client->dev_conn, &req);
|
|
|
|
|
|
|
|
robot->state = READY;
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
case READY:
|
|
|
|
case READY:
|
|
|
|
{
|
|
|
|
{
|
|
|
|
if(robot->dirty_wheels) {
|
|
|
|
if(robot->dirty_wheels) {
|
|
|
@ -327,10 +316,6 @@ robot_work(Robot robot) {
|
|
|
|
switch(resp.header.cmd) {
|
|
|
|
switch(resp.header.cmd) {
|
|
|
|
case 0:
|
|
|
|
case 0:
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
case STREAM_CTRL_CMD:
|
|
|
|
|
|
|
|
if(!resp.resp.sdkconn.retcode)
|
|
|
|
|
|
|
|
robot->state = STREAMING_ENABLED;
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
case VISION_DETECT_INFO_CMD:
|
|
|
|
case VISION_DETECT_INFO_CMD:
|
|
|
|
// enqueue rectangles
|
|
|
|
// enqueue rectangles
|
|
|
|
for(int i = 0; i < resp.push.vision.count; i++) {
|
|
|
|
for(int i = 0; i < resp.push.vision.count; i++) {
|
|
|
|