Commit 8d4ccc8e authored by Timothy Stack's avatar Timothy Stack
Browse files

Reset the position after the goto finishes.

parent 9027ca0a
......@@ -265,6 +265,7 @@ int main(int argc, char *argv[])
mup.robot_id = robot_id;
bot.getDisplacement(mup.position.x, mup.position.y);
bot.resetPosition();
mup.position.theta = theta;
if (rc < 0) {
mup.status = MTP_POSITION_STATUS_ERROR;
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment