some fixes..

3 years ago · f027cbb2e0
parent 155d093109
commit f027cbb2e0
1 changed files with 2 additions and 2 deletions
--- a/posctl.cc
+++ b/posctl.cc
@ -549,13 +549,13 @@ void PosCtl::CalibModeAxis(int x, int y) {
 		fp.y = -(y - calib_pos.y) / (float)timediff;

 		if (calib_mode ==  POSCTL_CALIB_MODE_AXIS1)	{
-			calib_axis1_v = fp;
+			calib_axis1_v = fp - calib_rot_v;
 			calc_vec2anglelen(&calib_axis1_v, &calib_axis1);
 			OutputWriteStop();
 			OutputWriteValue(1, CALIB_MAXSPEED);
 		}
 		else if (calib_mode ==  POSCTL_CALIB_MODE_AXIS2)	{
-			calib_axis2_v = fp;
+			calib_axis2_v = fp - calib_rot_v;
 			calc_vec2anglelen(&calib_axis2_v, &calib_axis2);
 			OutputWriteStart();
 		}