From e5f74a64ed814bec1bdff11a50566d8f40229216 Mon Sep 17 00:00:00 2001 From: Kevin O'Connor Date: Thu, 20 Jun 2019 15:44:45 -0400 Subject: polar: Add initial support for multiple bed rotations Signed-off-by: Kevin O'Connor --- klippy/kinematics/polar.py | 11 +++++++++-- 1 file changed, 9 insertions(+), 2 deletions(-) (limited to 'klippy/kinematics') diff --git a/klippy/kinematics/polar.py b/klippy/kinematics/polar.py index 2930152c..70b314eb 100644 --- a/klippy/kinematics/polar.py +++ b/klippy/kinematics/polar.py @@ -1,6 +1,6 @@ # Code for handling the kinematics of polar robots # -# Copyright (C) 2018 Kevin O'Connor +# Copyright (C) 2018-2019 Kevin O'Connor # # This file may be distributed under the terms of the GNU GPLv3 license. import logging, math @@ -122,8 +122,15 @@ class PolarKinematics: axes_d = move.axes_d cmove = move.cmove if axes_d[0] or axes_d[1]: - self.steppers[0].step_itersolve(cmove) self.rails[0].step_itersolve(cmove) + stepper_bed = self.steppers[0] + stepper_bed.step_itersolve(cmove) + # Normalize the stepper_bed angle + angle = stepper_bed.get_commanded_position() + if angle < -math.pi: + stepper_bed.set_commanded_position(angle + 2. * math.pi) + elif angle > math.pi: + stepper_bed.set_commanded_position(angle - 2. * math.pi) if axes_d[2]: self.rails[1].step_itersolve(cmove) -- cgit v1.2.3-70-g09d2