Changes between Initial Version and Version 1 of Tutorial3ServosCalibration


Ignore:
Timestamp:
Nov 22, 2017, 8:53:19 AM (8 years ago)
Author:
fma
Comment:

--

Legend:

Unmodified
Added
Removed
Modified
  • Tutorial3ServosCalibration

    v1 v1  
     1= Tutorial 3: Servos calibration =
     2
     3There are different reasons why we need to calibrate servos, depending on:
     4
     5 * how servos are attached to the robot
     6 * what servos we actually use
     7 * how accurate servos are
     8
     9'''{{{py4bot-gui-servocal.py}}}''' script can be used to fine tune our servos calibration, and generate the {{{SERVOS_CALIBRATION}}} dict.
     10
     11[[Image(py4bot-gui-servocal.png, 300px)]]
     12
     13Most servos have a range of 180° (more or less), and their neutral position (mid-range) is around 1500µs. It is important to mount the servos on the robot so the we can reach the joints positions ranges we want.
     14
     15The following picture shows the usual joints positions when servos are at neutral, for a 3 DoF leg:
     16
     17[[Image(IK3DoF_neutral.png, 300px)]]
     18
     19Looking how '''Py4bot''' internally manages angles ([[UserGuideGit#a3DoFleg]]), we can see that matching joints positions are:
     20
     21 * coxa = 0°
     22 * femur = 180°
     23 * tibia = 90°
     24
     25This means that there will be some offsets between the servo angles and the framework angles.
     26
     27Another thing to tune is the servo neutral position, to correct mechanical errors.
     28
     29Last thing to tune is the ratio between pulse variation and real servo displacement. This ratio varies a lot from a brand to another. And even for a same model, it varies from a servo to another. This is especially true for low cost servos.
     30
     31Offsets and ratios are defined in the {{{SERVO_CALIBRATION}}} table.
     32
     33Here is how to use '''{{{py4bot-gui-servocal.py}}}'''.
     34
     35We first need to enable the servo, by clicking the '''Enable''' checkbox. Then, we need to check if the servo rotates the right direction: increasing the pulse value should increase the joint angle (= make in turn in the trigonometric sense in the leg coordinate system). If it is not the case, we just click the '''Invert''' checkbox (usually, coxa joints are all the same, and other joints should be inverted for legs of one side, but it depends if there is a symmetry in the mechanics or not).
     36
     37Then, we can set the offset as shown above by moving the '''Offset''' slider. This has no impact on the servo position, but changes the table offset.
     38
     39Next, we need to fine tune the servo neutral position. To do this, we move the '''Neutral''' slider until we mechanically reach the correct neutral position.
     40
     41Once this is done, we can adjust the ratio. This step is a little bit harder, as we need to measure the angle the joint really moves. The best way is to move up to +-90°, as it is visually easy to see, but it is not always mechanically possible, and we can restrict the range to +-45°. But we have to keep in mind that the larger the angle is, the better the accuracy will be.
     42
     43So, we move the '''Test Angle''' slider to 45°. Then, we move the '''Ratio''' slider so the joint really reaches 45°. Finally, we can check if going to -45° moves the joint to the symmetrical position.
     44
     45We of course need to repeat the entire procedure for each servo/joint, which can be tedious for a 4 DoF hexapod :o/ But after that, our robot should walk better ;o)
     46
     47Note that if we already have a '''{{{settings.py}}}''' module, we can launch '''{{{py4bot-gui-servocal.py}}}''' from the directory containing that module in order to reload the previous values. And if the module contains a '''{{{LEGS_SERVOS_MAPPING}}}''', the script will show the legs/joints names. So, it is better to start writing this param, before launching the script.
     48