control_system
Differences
This shows you the differences between two versions of the page.
Both sides previous revisionPrevious revisionNext revision | Previous revision | ||
control_system [2021/06/08 13:52] – ursgraf | control_system [2023/05/11 17:13] (current) – [Motor Model] ursgraf | ||
---|---|---|---|
Line 2: | Line 2: | ||
The coordinate system is as follows | The coordinate system is as follows | ||
- | [{{ : | + | [{{ : |
- | \\ | + | In z direction, positive values move the TCP upwards. |
\\ | \\ | ||
The figure below shows the complete control system for our delta roboter. | The figure below shows the complete control system for our delta roboter. | ||
- | {{: | + | {{: |
Line 32: | Line 32: | ||
* The '' | * The '' | ||
* The '' | * The '' | ||
+ | |||
+ | You have to make sure, that the path planner delivers a path with a acceleration and velocity which can in fact be achieved by the robot. If not, the arm might move in unpredictable ways. That is, moving from e.g. 0/5 to 5/5 must be made in a straight line. | ||
==== Controller ==== | ==== Controller ==== | ||
- | The "Motor Model" | + | The position of the TCP is controlled by taking in the setpoint (see above) and adding planned velocities and accelerations. The resulting total acceleration is then fed into the block ' |
- | The " | + | |
+ | ==== Motor Model==== | ||
+ | As our board cannot only control voltages fed to each motor, we must use a motor model to calculate these voltages. The block 'Motor Model' | ||
+ | < | ||
+ | U = kM * w + I * RA + dI/dt * L | ||
+ | </ | ||
+ | with I = M / kM and dI/dt * L beeing very small with our motors and accounting for the gear i we get | ||
+ | < | ||
+ | U = kM * w * i + M * RA / (kM * i) | ||
+ | </ | ||
==== Outputs ==== | ==== Outputs ==== | ||
The drive signals to the motor are of type '' | The drive signals to the motor are of type '' | ||
Line 42: | Line 53: | ||
eeros:: | eeros:: | ||
</ | </ | ||
+ | |||
+ | The block ' |
control_system.1623153166.txt.gz · Last modified: 2021/06/08 13:52 by ursgraf