ntb:motors_init
Differences
This shows you the differences between two versions of the page.
Next revision | Previous revision | ||
ntb:motors_init [2019/12/01 07:54] – created graf | ntb:motors_init [2023/05/25 14:47] (current) – [Mechanical Limits of the Tool Center Point Motor] ursgraf | ||
---|---|---|---|
Line 1: | Line 1: | ||
====== Initialization - Zero reference ====== | ====== Initialization - Zero reference ====== | ||
- | The '' | + | The initialization for the axis motors is the same as [[: |
- | ==== Mechanical Limits of the Axis Motors - Upper limit ==== | ||
+ | ==== Mechanical Limits of the Tool Center Point Motor ==== | ||
+ | The TCP rotation is limited by two metall pins. The maximum turn angle is calculated as follows:\\ | ||
+ | {{ : | ||
- | |{{: | + | sin(γ/2) = r/R |
- | |Upper limit calculation shown below| Upper limit calculation detail | | + | γ=2*arcsin(r/ |
+ | |||
+ | That is the value for one side. The other side is identical, so the maximum turn angle is | ||
- | L = 17.5 \\ | + | β = 2*PI - 2 * 0.06 = 6.16 (rad) ≅ 353° |
- | B = 15 | + | |
- | s = 4 \\ | + | |
- | + | ||
- | The upper limit can be calculated as follows: | + | |
- | \\ \\ | + | |
- | //(1) tan(β) = sin(β)/ | + | |
- | //(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*tan(β/ | + | |
- | //(6) sin(β) = (1-tan^2(β/ | + | |
- | \\ | + | |
- | Leads to: | + | |
- | \\ \\ | + | |
- | //(7) (s+B)*t^2 + 2*L*t + (s-B) = 0// \\ | + | |
- | \\ | + | |
- | Solutions are: | + | |
- | \\ | + | |
- | // t1 = 0.2736 -> β = 30.6°// \\ | + | |
- | // t2 = -2.1157 | + | |
- | \\ | + | |
- | Hence, the maximum angle the axis can turn is // 90° + β ≅ 120°// | + | |
- | \\ | + | |
- | + | ||
- | ==== Mechanical Limits of the Axis Motors - Lower limit ==== | + | |
- | + | ||
- | + | ||
- | {{: | + | |
- | + | ||
- | Lower limit of the Axis Motor measured on the Delta robot, γ is about 5°. | + | |
- | + | ||
- | ==== Mechanical Limits of the Tool Center Point Motor ==== | + | |
- | The TCP rotation is also limited by two metall pins. The maximum turn angle is calculated as follows: | + | |
- | {{ : | + | |
- | //sin(γ/2) = r/R//\\ | + | Zero position |
- | // | + | |
- | \\ | + | |
- | That is the value for one side. The other side is identical, so the maximum turn angle is\\ | + | |
- | \\ | + | |
- | //β = 2*PI - 2 * 0.06 = 6.16 (rad) ≅ 353°//. | + | |
+ | :!: Make sure that the TCP is properly fixed on the motor shaft. Two tiny screws must be carefully tightened. |
ntb/motors_init.1575183242.txt.gz · Last modified: 2019/12/01 07:54 by graf