diff --git a/posctl.cc b/posctl.cc
index e69fe5f..6823134 100644
--- 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();
 		}