Change the direction of azimuth orientation

Signed-off-by: zisi <agzisim@gmail.com>
merge-requests/5/head
zisi 2018-08-19 16:17:39 +03:00
parent 5e52770db6
commit 961fb69653
1 changed files with 1 additions and 1 deletions

View File

@ -78,7 +78,7 @@ public:
else if (delta_raw_pos < -180)
_n--;
// Calculate the real angle
real_pos = ((raw_pos + 360 * _n) / _enc_ratio) - _angle_offset;
real_pos = - ((raw_pos + 360 * _n) / _enc_ratio) - _angle_offset;
_raw_prev_pos = raw_pos;
}
*new_pos = (double)real_pos;