auto hover when bad Plan
This commit is contained in:
parent
40fca6a442
commit
6d91edfe5b
1 changed files with 3 additions and 1 deletions
|
@ -91,7 +91,7 @@ class Run
|
||||||
dz = (z_current - z_previous)/((t_current - t_previous).toSec());
|
dz = (z_current - z_previous)/((t_current - t_previous).toSec());
|
||||||
ROS_INFO("dz = %f", dz);
|
ROS_INFO("dz = %f", dz);
|
||||||
}
|
}
|
||||||
|
|
||||||
xx = msg->normal.x;
|
xx = msg->normal.x;
|
||||||
ROS_INFO("xx = %f", xx);
|
ROS_INFO("xx = %f", xx);
|
||||||
yy = msg->normal.y;
|
yy = msg->normal.y;
|
||||||
|
@ -107,6 +107,8 @@ class Run
|
||||||
ROS_INFO("first msg received");
|
ROS_INFO("first msg received");
|
||||||
}
|
}
|
||||||
ROS_INFO("coords updated");
|
ROS_INFO("coords updated");
|
||||||
|
} else {
|
||||||
|
xx = yy = dz = 0.;
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue