mirror of
https://github.com/Klipper3d/klipper.git
synced 2025-08-08 06:24:03 -06:00
polar: Add initial support for multiple bed rotations
Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
This commit is contained in:
parent
d9d94c858a
commit
e5f74a64ed
4 changed files with 59 additions and 8 deletions
|
@ -1,6 +1,6 @@
|
|||
// Polar kinematics stepper pulse time generation
|
||||
//
|
||||
// Copyright (C) 2018 Kevin O'Connor <kevin@koconnor.net>
|
||||
// Copyright (C) 2018-2019 Kevin O'Connor <kevin@koconnor.net>
|
||||
//
|
||||
// This file may be distributed under the terms of the GNU GPLv3 license.
|
||||
|
||||
|
@ -24,8 +24,12 @@ polar_stepper_angle_calc_position(struct stepper_kinematics *sk, struct move *m
|
|||
{
|
||||
struct coord c = move_get_coord(m, move_time);
|
||||
// XXX - handle x==y==0
|
||||
// XXX - handle angle wrapping
|
||||
return atan2(c.y, c.x);
|
||||
double angle = atan2(c.y, c.x);
|
||||
if (angle - sk->commanded_pos > M_PI)
|
||||
angle -= 2. * M_PI;
|
||||
else if (angle - sk->commanded_pos < -M_PI)
|
||||
angle += 2. * M_PI;
|
||||
return angle;
|
||||
}
|
||||
|
||||
struct stepper_kinematics * __visible
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue