Compensating for hardware limitations¶
Make no mistake: any engineer can tell you that the BrachioGraph is no way to build a plotter. Hobby servo motors are underpowered, imprecise and not designed for this kind of job. Ice cream sticks lack rigidity. The pen-lifting mechanism tends to move the pen sideways. And so on.
That is partly what makes it fun, that it does things its parts are not ideally suited to, and does them well enough to make the results interesting and worthwhile in their own right.
To get the best results involves understanding the limitations of the hardware, and finding ways to compensate for them.
By default, the BrachioGraph assumes a linear response from the motors. This basic form of this naive formula is for the pulse-width required for a particular angle is:
pw = 1500 + angle x 10
(1500µS is the nominal centre of a servo’s sweep, and a change of 10µS generally seems to correspond to 1˚ of movement.)
naive_angles_to_pulse_widths methods for how this formula is implemented.
However, servo motors are far from being perfectly linear. A linear relationship between pulse-widths and resulting angles would be a straight line. In practice, they can look rather like this:
If we know the characteristics of the non-linearity, we can compensate for it. By recording a series of actual pulse-width values and their corresponding angles, we can use Numpy’s polyfit module to obtain a function for this non-linear relationship.
The BrachioGraph is susceptible to hysteresis, a tendency of the system to maintain its state. In this case, it means that if the device receives a command to move to a certain point, where it actually arrives can depend on the direction it was coming from.
The motors themselves, even more accurate and expensive ones with metal gears and high torque, exhibit hysteresis, even when under no load. For example, say that at 1500µS your motor is at 0˚. You may find that changing the pulse-width from 1500µS to 1510µS moves the arm anti-clockwise by 1˚, but setting it back to 1500µS does nothing, and the motor does not move back to 0˚ until the pulse-width is set to 1490µS.
In other words, the position of the motor at 1500µS is dependent upon the its previous state; in this example it will be 0˚ when moving anti-clockwise and -1˚ when moving clockwise.
The mechanical system¶
In addition, the mechanical system - the arms, the joints and the way the pen is held - adds more hysteresis. As the motors move, some of that movement will be taken up by flexing and mechanical free-play in the system, so that the actual relationship between pen position and pulse-width can suffer from a dead-band of more than 15µS when changing directions.
The result of this hysteresis is imprecision that depends on direction. Drawing a grid with the lines first in one direction and then another will make this obvious:
Compensation for hysteresis¶
The BrachioGraph can compensate for hysteresis by anticipating it. In the example above, adding or subtracting a constant to the pulse-width value when it is increasing or decreasing will help eliminate the dead-band:
The correction values are supplied as
hysteresis_correction_2 parameters to the
BrachioGraph instance. See Hysteresis compensation for how to determine these values.