motors_init
Initialization - Zero reference
During homing the robot has to set his zero position. Zero position is choosen as the point where all three arms of the robot are in horizontal position.
Mechanical Limits of the Axis Motors - Upper limit
The mechanical dimensions are given by L = 0.0175m, B = 0.015m, s = 0.006m. The upper limit can be calculated as follows:
(1) tan(β) = sin(β) / cos(β) = (B - y) / L (2) cos(β) = s / y
Substitute (2) into (1) to get:
(3) L * sin(β) - B * cos(β) = -s
Using following trigonometric formulas in (3):
(4) t = tan(β / 2) (5) sin(β) = 2 * t / (1 + t^2) (6) sin(β) = (1 - t^2 / (1 + t^2)
Leads to:
(7) (s + B) * t^2 + 2 * L * t + (s - B) = 0
Solutions are:
t1 = 0.2264 -> β = 0.445 t2 = -2.1157 (neg. solution)
Hence, the maximum angle the axis can turn is π/2 + β ≅ 2.016.
Mechanical Limits of the Axis Motors - Lower limit
motors_init.txt · Last modified: 2021/06/11 16:19 by ursgraf