calibration
Differences
This shows you the differences between two versions of the page.
Both sides previous revisionPrevious revisionNext revision | Previous revisionNext revisionBoth sides next revision | ||
calibration [2019/07/19 16:08] – visentin | calibration [2019/08/07 15:50] – visentin | ||
---|---|---|---|
Line 1: | Line 1: | ||
- | ====== Zero reference for axes ====== | + | ===== Calibrating the Delta Robot ===== |
- | The '' | + | If you need to calibrate |
- | ==== Mechanical Limits of the Axis Motors ==== | + | - The Delta robot has to be powered |
- | The axis motors have mechanical upper and lower limits. | + | - If the Delta is not in it's homing position: |
+ | | ||
+ | - Else: | ||
+ | - Press the green and blue button | ||
+ | - Remove all plates | ||
- | ^Upper limit^Upper limit detail^Lower limit^ | + | You have to calibrate the Delta with each plate. Start with plate 0 -> that means no plate is used, and position 0. |
- | |{{: | + | - Put the actual plate to the actual position and move the TCP to the center of this position. |
- | |Upper limit calculation shown below| Upper limit calculation detail |Lower limit of the Axis Motor | | + | - Hit the blue button. |
- | + | - Move the TCP inside | |
- | L = 17.5 \\ | + | - Hit the blue button again. |
- | B = 15 \\ | + | - If the actual position is number |
- | s = 4 \\ | + | - If the actual plate is number 3 you are finished. Else use the plate with the next higher number and start again with step 1. |
- | + | ||
- | 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 (neg. solution)// \\ | + | |
- | \\ | + | |
- | Hence, | + | |
- | \\ | + | |
- | 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:\\ | + | |
- | {{ :delta:tcp-limit.jpg? | + | |
- | + | ||
- | //sin(γ/2) = r/R//\\ | + | |
- | // | + | |
- | \\ | + | |
- | 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°//. | + | |
+ | If you have calibrated all blocks on every position, put all blocks back and press the blue button. The Delta will move to it's homing position. |