Commit 86dbbbfa authored by Timothy Stack's avatar Timothy Stack

fix reported robot orientation

parent e3bde0ea
......@@ -1787,7 +1787,7 @@ int update_callback(elvin_timeout_t timeout, void *rock, elvin_error_t eerror)
float orientation;
erc = robot_list_search(hostname_list, mup->robot_id);
orientation = mup->position.theta * 180.0 / M_PI;
orientation = mtp_theta(mup->position.theta) * 180.0 / M_PI;
if (!cmp_fuzzy(erc->last_update_pos.x, mup->position.x, 0.02) ||
!cmp_fuzzy(erc->last_update_pos.y, mup->position.y, 0.02) ||
!cmp_fuzzy(erc->last_update_pos.theta, mup->position.theta, 0.04)) {
......
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