Step 1b: Calibrate the motors (Adv)
Tutorial: pib#5 Motor CalibrationEvery motor has to be calibrated before it is built into pib. pib#5 Advanced uses two motor types — 26 motors in total for a two-arm pib: 18x E27-STS3215, 4x E18-STS3095 and 4x ST3200. All of them are calibrated the same way: each motor is set to its middle position and gets its own ID. We suggest building pib’s head and installing the software on the Raspberry Pi first. You need a Windows PC with the FD servo software for the calibration!
|
|
|---|
Overview: Needed Parts
Non-printable Parts:
| Also needed:
|
Step-by-Step Tutorial
Step 0: Motors to Calibrate |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Calibrate all motors with this tutorial before you build them into pib: 18x E27-STS3215, 4x E18-STS3095 and 4x ST3200
|
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Step 1: Connect the Power Supply |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Plug the output jack of E14-Power_Supply into the Bus Servo Adapter and connect the adapter to your PC with a USB-C cable. Needed Parts: 1x E14-Power_Supply, 1x Bus Servo Adapter, 1x USB-C cable |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Step 2: Connect a Motor |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Connect the motors one at a time to the Bus Servo Adapter using their cable. Each motor gets its ID and is calibrated on its own. |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Step 3a: Install the Serial Driver |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Download the software package from this link. Install the serial driver: open CH34x_install_Windows_v3_4.exe and follow the setup wizard. |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Step 3b: Open the FD Software |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Open FD_1_9_8_1.exe from the software package. |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Step 4: Set the Middle Position |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Click Com and select the open port, choose the baud rate 1000000 and click Open. Then click Search. Select the motor that appears in the list and click Set to move it to the middle position 2047. |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Step 5a: Set the Motor ID |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Click Programming, enter the ID of the motor from the table in Step 5b and click Save. |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Step 5b: Table of Motor IDs |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Give every motor the ID of its joint. The table shows each ID, its motor type and the bricklet (Bus Servo Adapter 1–4) it is connected to later. The E18-ST3200 motors are the shoulder verticals (inner shoulders), and the elbows.
|
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Note: Daisy Chain |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
This can only happen after calibration. Serial servos are connected in a daisy chain. Every servo has two ports: use one to connect to the next motor and the other one towards the bricklet. Only motors of the same bricklet are daisy-chained, and one cable goes from the motor where the chain starts to its bricklet. The picture shows an example. |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Note: Servo Cables |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
For all next steps you can use three kinds of cable with the servo motors. All of them work, but the middle one is the best: it fits better and comes in different lengths, so you don’t need extension cables. |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Step 6: Calibrate the Remaining Motors |
| ||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||||
Disconnect the calibrated motor, connect the next one and repeat Steps 4 to 5a until all motors are calibrated. Important: After a motor has been calibrated, avoid turning its shaft until the motor is installed in its final position. Once finished, you can take the setup apart: you will need the power supply, the cables and the motors in the other tutorials. |
|
Congratulations! All motors are calibratedE-Mail Support: team@pib.rocks | Discord: discord.gg/GRdpyeDu7P | Web: pib.rocks | Shop: shop.pib.rocks |