Tuning Recipe: Difference between revisions

From STorM32-BGC Wiki V1
Jump to navigation Jump to search
 
(73 intermediate revisions by the same user not shown)
Line 1: Line 1:
The biggest problem for people new to brushless gimbals is finding the correct values of the PID parameters. A PID controller is a well known and often used method for calculating a new input value by measuring the difference between the current state compared with the target state and applying a formula to the difference. In theory, after such a calculation, the target state would be reached immediately, but in reality the motor is not indefinitely fast. So in the next iteration there will be still an error, smaller but it exists, and a better input value will be calculated based on the new difference between actual and target states.
<span style="font-size:88%">''by Yang/wdaehn, with edits by OlliW</span>''


Due to this iterative approach the control loop can react very precisely to any kind of distortions, but all sorts of bad things might happen if the formula is wrong. For example, the camera might look down by 15°, and our formula might be: motor power = 15° * 2 W/°. With this amount of power the motor will however rotate 30° upwards instead of the expected 15°, and the camera looks up by 15°. Thus, in the next iteration, a motor power of -15° * 2 W/° = -30 W is calculated and the direction is reversed. The resulting effect would be a shaking of the motor and camera between the +15° and -15° positions. The formula used by a PID control algorithm is more advanced than in the above example, and is optimized for quick reaction without overshooting the target position (much). But even here, when the parameters are wrong, you get all kinds of weird movement patterns.
A major problem for people new to brushless gimbals is finding the correct values of the PID parameters. A PID controller is a well known and often used method for calculating a new input value by measuring the difference between the current state and a target state, and applying a formula to the difference. In theory, after the calculation is applied, the target state would be reached immediately, but in reality it is not, because e.g. the motor is not indefinitely fast. So in the next iteration there is still an error, smaller but it exists, and an improved input value is calculated based on the new difference between actual and target states.
 
Due to this iterative approach the control loop can react precisely to any kind of distortions, but all sorts of bad things might happen if the formula is wrong. For example, the camera might look down by 15°, and our formula might be: motor power = 15° * 2 W/°. With this amount of power the motor will rotate 30° upwards, instead of the desired 15°, and the camera will look up by 15°. Thus, in the next iteration, a motor power of -15° * 2 W/° is calculated, and the direction is reversed. The resulting effect would be a shaking of the motor and camera between the +15° and -15° positions. The formula used by a PID control algorithm is more advanced than in this example, and is optimized for quick reaction without overshooting the target position (too much). But even then, when the parameters are wrong, one gets all kinds of weird movement patterns.


See [http://en.wikipedia.org/wiki/PID_controller Wikipedia] for further details on PID control.
See [http://en.wikipedia.org/wiki/PID_controller Wikipedia] for further details on PID control.
Below a relatively simple and straight forward tuning technique is suggested, which often works surprisingly well, and has a theoretical foundation. However, it may also fail. In fact, it is important to realize that some gimbals might not be tunable at all, because e.g. too weak or too strong motors are used, and other reasons. As a rule of thumb: When you don't get a good tuning within 10 min (per axis) then chances are that something is wrong with the gimbal design. There ain't no such thing as a hard to tune gimbal. There are just well and badly designed gimbals.


== Balancing the Gimbal ==
== Balancing the Gimbal ==


Before you do any tuning, the gimbal needs to be balanced. Balancing means to bring the center of gravity of the mounted camera into the center of all three gimbal motor axes (depending on the gimbal construction it is also part of the balancing to ensure that all three gimbal motor axes cross in one point). This can be tested quite easily by moving the camera by hand while all gimbal motors are turned off: The camera should remain in its position whenever you let it go, as demonstrated in the video below.
Before any tuning, the gimbal needs to be balanced. Balancing means to bring the center of gravity (COG) of the mounted camera into the center of all three gimbal motor axes (depending on the gimbal construction it is also part of the balancing to ensure that all three gimbal motor axes cross in one point). A quick test, which may be sufficient for larger cameras, is to move the camera by hand while all gimbal motors are turned off: The camera should remain in its position whenever you let it go, as demonstrated in the video below.


A perfectly balanced gimbal has many advantages:
A perfectly balanced gimbal has many advantages. Otherwise you will get artefacts:
* When the gimbal as a whole is accelerated, the camera would rotate out of position due to residual forces - see the image below.
* When the gimbal as a whole is accelerated, the camera would rotate out of position due to residual forces - see the image below.
* The motors need to apply more power to keep the camera in the selected position.
* The motors need to apply more power to keep the camera in position.
* When moving the camera, e.g. with the RC stick, the center of gravity would change its positions with respect to the center of the gimbal motor axes, which would "confuse" the PID controller.
* When turning the camera, e.g. with the RC stick, the center of gravity would change its positions with respect to the center of the gimbal motor axes.
* The PID control actions on different axes get correlated.
* Vibrations in the gimbal are more easily induced.
 
Balancing not only brings advantages, a minimu degree of balancing is in fact mandatory for the gimbal and controller to function at all. It's as simple as that: The better the balancing the better the gimbal performance. This holds true especially for a 3-axis gimbal.
 
You will always have to compromise, because e.g. the gimbal does not allow for infinitely precise adjustments, or because of friction in the motors, and so on. Hence take considerable effort in balancing the gimbal as good as possible, but at some point one of course has to let go.  


In reality you will always have to compromise, because e.g. the gimbal does not allow for infinite adjustments, or friction, and so on. Hence take considerable effort to balance the gimbal as good as possible, but at some point it will be good enough. In general, the smaller the camera the more important is the balance.
The picture below shows a very badly balanced situation. The center of gravity is quite below the pitch motor axis. At first this might actually look like a good idea, since the camera gets "self-stabilized" by gravity. However, consider now the gimbal being accelerated to the right. Because the center of gravity is below the pitch axis, where would be a force on the camera and it would tilt downwards. The PID controller would have to fight against that, which makes it much harder or even impossible for it to stabilize the camera.


The following picture shows a badly balanced situation. Consider the copter being accelerate to the right. Because the center of gravity is below the pitch axis, the camera would turn a bit downward then.
The video shows a well balanced gimbal. Here it is possible to move the camera to any orientation and let it free, without it turning back to a preferred orientation.
 
Please also consider these tips:
* It is {{WARNING|'''important'''}} to electrically disconnect the motors from the board, since then they can rotate more freely than just being disabled in the GUI.
* A much more severe test to check balance is to heavily shake the gimbal, up and down, left and right, forward and backward. When balanced, the camera will stay in the position it was before the shaking started. Do this for different camera positions.
* A 3-axis gimbal requires more precise balancing than a 2-axis gimbal. Especially the yaw axis needs attention.
* In general, the smaller the camera the more important is the balance.


[[File:DSC_7111.jpg]]
[[File:DSC_7111.jpg]]
Line 24: Line 40:
== Tuning Procedure ==
== Tuning Procedure ==


As each value on every axis might impact the other axis, best approach is to enable one axis after the other. Hence the first step in tuning a brand new gimbal would be to disable all motors except the Pitch motor and find the proper parameters for that. Then enable the Roll motor and tune its parameters, finally the Yaw axis.
The tuning of one axis might impact the other axis, so it is best to tune one axis after the other. Accordingly, the first step in tuning a brand new gimbal is to disable all motors except of the pitch motor, and find the proper tuning parameters for it. Then the roll motor is enabled and the corresponding PID parameters are tuned. Finally, the yaw axis is done.
Our goal with the PID tuning is to find the highest value for each of the {{GUI|P}}, {{GUI|I}} and {{GUI|D}} parameters, that work stable still. The higher the values are the higher the corrective signal will be and the better distortions can be compensated. If one of the values are too large, it does overcompensate, something we would notice as oscillations, noise or erratic behavior in worst case.
Another point is we will start with a low value, then increase it until we get into an area the gimbal starts to behave imperfectly and then we move back until it works again. The reason is simply when increasing the value we test the control loop behavior while the gimbal has no distortions at all. Once these distortions are visible and we reduce the parameter value again, we will find the value needed to balance an currently oscillating gimbal. A concrete example from below videos: A value D = 0.04 was picked, everything was fine. It got increased to 0.05, everything was fine still. At D = 0.06 heavy vibrations were visible, hence I did step back to the previous D = 0.05 value but now there were vibrations here as well! I could manually move the motor into a different position and then the vibrations are gone. What happened?
At 0.06 I was at a resonance frequency of the control loop, but with a slight decrease back to 0.05 the frequency was very similar still and the control loop was not able to get out of this by itself. To be on the safe side I picked 0.04 for {{GUI|D}}, as at this value the shaking did stop by itself.
The other thing I do is turning the motors by hand into all allowed positions. Please note, this has less to do with the PID regulation as such, it is a test if the current parameter values work in all positions rather. If the gimbal and camera would be balanced perfectly, there would not be a need for that. But in reality....


[[File:1main.png]]
Our goal in the PID tuning is to find the highest value for each of the {{PARAMNAME|P}}, {{PARAMNAME|I}} and {{PARAMNAME|D}} parameters which still work stably. The higher the values the better distortions can be compensated, and the more accurate the camera will be hold in position. If a value however is too large, then the PID controller will overcompensate, and we will notice oscillations, noise, or even erratic behavior in the worst case.


To find the sweet point we will start with a low value, increase it until the gimbal starts to misbehave, and move back until it works again. This will be done first for the {{PARAMNAME|D}} parameter, when the {{PARAMNAME|P}} value, and last but not least the {{PARAMNAME|I}} term.
Before that, we will have to set the {{PARAMNAME|Motor Vmax}} parameter, which also affects the tuning. Fortunately, it is relatively easy to adjust and not too critical (unless the gimbal tends to vibrations at certain gimbal postions).
The procedure is illustrated below also by videos.
Further tips:
* A parameter setting may be double-checked by turning the motors by hand into all allowed positions. This has less to do with the PID regulation by itself, but tests whether the current parameter values work well in all positions. If the gimbal and camera would be balanced perfectly, then there wouldn't be a need to do that, but, reality ...
[[File:Storm32-wiki-imu-pid-01.jpg|480px]]
<!-- this simulator isn't a PID simulator!
=== The Online PID Simulator ===
=== The Online PID Simulator ===
If you want to know more about the PID control loop, there is a [[PID online simulator]] page showing the effects in a diagram and let you play with the various parameters.
If you want to know more about the PID control loop, there is a [[PID online simulator]] page showing the effects in a diagram and let you play with the various parameters.-->


=== The Starting Point ===
=== The Starting Point ===


Set the {{GUI|P}}, {{GUI|I}} and {{GUI|D}} value to zero. Without a {{GUI|P}} and {{GUI|I}} there will no position correction at all, the motor will just hold its current position.
Set the {{PARAMNAME|P}}, {{PARAMNAME|I}} and {{PARAMNAME|D}} values to zero.  


=== Setting Vmax ===
Also, ensure that:
* All three axes should be in hold mode, i.e., in the {{GUI|Pan}} tab the parameters {{PARAMNAME|Pitch Pan}}, {{PARAMNAME|Roll Pan}} and {{PARAMNAME|Yaw Pan}} should be set to zero or alternatively the {{PARAMNAME|Pan Mode Default Setting}} set to {{PARAMVALUE|hold hold hold}}.
* {{PARAMNAME|Voltage Correction}} should be set to 0%.
* A 2nd IMU should be deactivated, i.e., in the {{GUI|Setup}} tab the parameter {{PARAMNAME|Imu2 Configuration}} should be set to {{PARAMVALUE|off}}.
* The battery should neither be fully charged nor nearly discharged, i.e., have a voltage of about 3.7 V per cell.


With this {{GUI|Vmax}} parameter we control the amount of energy applied to the motor. The software has the option to increase the value if required, that is controlled by the {{GUI|Voltage Correction}} percentage, which would be yet another unpredictable variable impacting the tuning. Hence set this to zero for now.
=== Setting Motor Vmax ===
Now turn the motor by hand against the motor momentum and predict how much force will be required to hold the camera in a steady position at any time.


In this example video the starting value is 190 and there is a clear resistance to any manual movement. Then the value gets reduced to 55 and you can see that the motor can be turned almost freely. In fact, it does not even have enough power to keep the current position - so much about my gimbal being balanced perfectly, right? And finally the value is set to its max of 255.
The {{PARAMNAME|Motor Vmax}} parameter, or {{PARAMNAME|Vmax}} in short, determines the amount of energy applied to the motor. <!--The firmware has the option to increase the motor power when the battery voltage drops, depending on the {{PARAMNAME|Voltage Correction}} percentage. This however adds another variable, and hence should hence be set to zero for now.--> It should be large enough, such that the motor has enough strength to hold the camera in position, but on the other hand should not be that large that the motor overheats.  
In principle using the max value would be okay, except that it is a waste of battery power and the motor might get hot. Therefore the advice is to define a useful low {{GUI|Vmax}} value, in case this is too low in extreme situations, we can allow temporarily higher values later by using the {{GUI|Voltage Correction}} option.


Note: A common misconception is that the motor needs to work against the static forces of an improperly balanced gimbal only. Hence you can get away with smaller motors if only your gimbal is very well built. This is true from the static forces. But as soon as you want to move the camera with the stick, the motor has to work against the mass momentum of the camera. And then there are unpredictable dynamic forces like wind resistance etc. Keep all of that in mind when estimating the amount of force the motor should apply to the camera.
To determine the required motor power, turn the motor by hand against the motor's momentum and predict how much force will be needed to hold the camera in a steady position at any time. In the example video, the starting value for {{PARAMNAME|Vmax}} is 190, and the motor shows a clear resistance to any manual movement. With the value reduced to 55, the motor can be turned almost freely. In fact, it does not even has enough power to keep the current position - so much about my gimbal is balanced perfectly, right? Finally the behavior is shown with {{PARAMNAME|Vmax}} set to the maximum value of 255.
 
In principle, using the maximum value would be okay, except that it is a waste of battery power and the motor might get hot. Also, with larger {{PARAMNAME|Vmax}} stronger micro motions of the motor are produced and, depending on the gimbal, the gimbal may more easily develop vibrations.
 
Therefore the advice is to define a useful low {{PARAMNAME|Vmax}} value.
 
{{COMMENT|A common misconception is that the motor needs to work only against the forces/torques due to an improperly balanced gimbal, and that one thus can get away with smaller motor power or motors if only the gimbal is very well built. However, if one wants to move the camera with the stick or wants the camera to follow the gimbal (pan mode), then the motor has to work also against the mass momentum of the camera. Unpredictable dynamic forces such as wind and so on come in additionally. Keep all of that in mind when estimating the amount of force the motor should apply to the camera.}}


{{#ev:youtube|wq6e38EWjWE}}
{{#ev:youtube|wq6e38EWjWE}}


=== The D-Parameter ===
=== The D Parameter ===


The {{GUI|D}}erivative term of the PID control loop is not directly related to the movement of the gimbal, it is a high frequency correction looking ahead, in order to dampen future oscillations. If this value is too high, the frequency of the correction itself gets visible/audible. Therefore, by keeping {{GUI|P}} and {{GUI|I}} at zero and just increasing the {{GUI|D}} value, we can see at what value no high frequency noise is audible on the gimbal motor. The value should be as large as possible but without noise. Once you found a good value, move the motor by hand to doublecheck no noise is at any motor position the gimbal might ever reach. If you find one value working in almost all positions except one, that would be an indicator for an imperfectly balanced gimbal on this axis. Go back to start.
With {{PARAMNAME|P}} and {{PARAMNAME|I}} set to zero, there is no position correction at all, that is the motor will simply stay in its current position.


Note: In the GUI you can move the slider with the cursor keys as well. Click on the slider handle and then one click with the left/right key does change the value by its minimal step width. Very useful, especially for the {{GUI|D}} values.
The {{PARAMNAME|D}}erivative term of the PID control loop is not directly related to the movement of the camera. It is a high frequency correction looking ahead, in order to dampen what in future could become oscillations. If the {{PARAMNAME|D}} value is too high, then the frequency of the correction gets visible and/or audible. Therefore, by keeping {{PARAMNAME|P}} and {{PARAMNAME|I}} zero and just increasing {{PARAMNAME|D}}, one can find a point at which an audible high-frequency noise, produced by the gimbal motor, appears. The {{PARAMNAME|D}} value should be as large as possible without any noise occuring. Once a good value is found, one should move the motor by hand to doublecheck that no noise appears for any gimbal position. If a {{PARAMNAME|D}} value is working great in almost all positions except one, then that would be indication of an imperfectly balanced gimbal. Go then back to start.


Listen to this video here. Initially D = 0.17 and the gimbal is shaking like mad. A very low frequency with high amplitudes. Then the value is reduced to D = 0.10 which lets the position to remain stable but a higher frequency noise can be heard clearly. With D = 0.05 the frequency is even higher, we want the frequency to be so high that no noise is audible. At D = 0.04 the noise is suddenly gone.
An example tuning is illustrate in the video. Listen to it (switch on audio). Initially D = 0.17, and the gimbal is shaking like mad, with low frequency and high amplitudes. Then the value is reduced to D = 0.10, and the camera position becomes stable, but a high-frequency noise can clearly be heard. With D = 0.05 the frequency gets even higher. We want the frequency to be that high that no noise is audible. At D = 0.04 the noise is suddenly gone.
 
Before the video was taken, the following actually happened. First D = 0.04 was picked, and everything was fine. With increasing it to 0.05, everything was still fine. At D = 0.06 heavy vibrations were visible, hence the previous D = 0.05 value was set, but now vibrations were still present! In this situation one could manually move the motor into a different position and the vibrations would go away. What happened? At D = 0.06 the resonance frequency of the control loop was hit, but with a slight decrease to 0.05 the frequency remained very similar and the control loop was not able to get out of it by itself. So, to be on the safe side D = 0.04 was chosen, as for this value the shaking stopped by itself. The message is that it's quite natural to observe a hysteresis, that is that when coming from large D values one needs to go to smaller D values to stop a vibration than the other way around. Choose the smaller D value, at which the vibrations stop.
 
{{COMMENT|In the GUI you can move the slider also using the cursor keys. Click on the slider handle with the mouse, and hit the left/right key to change the value by its minimal step width. Very useful, especially for adjusting D.}}


{{#ev:youtube|voxJ9IAcaQg}}
{{#ev:youtube|voxJ9IAcaQg}}


=== The P-Parameter ===
=== The P Parameter ===


Now set the {{GUI|I}} value to 5, which is the lowest non-zero value and start tuning the {{GUI|P}}roportional term of the PID controller. This constant is multiplied with the positional error to get the correction amount. Exactly like in the example in the introduction at the top of this page. The higher the factor is the higher the calculated correction amount will be. If it is too high we will have the tendency of overshooting the target position and if it is way too high we would get even totally erratic movements. Hence our goal is to have a very high value here but a smooth movement in all motor positions.
Before starting the tuning of the {{PARAMNAME|P}}roportional term of the PID controller, set the {{PARAMNAME|I}} parameter to a low value, for instance 5, which is the lowest non-zero value.  


The video below shows the procedure. After five seconds the {{GUI|P}} and {{GUI|I}} are set to values greater than zero and the Gimbal moves into a level position automatically. Then the {{GUI|P}} value is increased and we keep seeing the same behavior. Once P = 15 there are some weird shakes when the motor is released from a tilted position, which gets worse and worse and with P = 23 the camera does shake for a while even. Only once the {{GUI|P}} value is down at 13.0 a smooth movement from all positions is achieved again.
The {{PARAMNAME|P}} constant is multiplied with the positional error to get the correction amount, exactly as in the example discussed in the introduction. The higher the {{PARAMNAME|P}} factor is the larger the calculated correction will be. If it is too high, then the PID controller will have the tendency to overshoot the target position, and when it is much too high it even produces totally erratic movements. Hence, the goal is to have both a high {{PARAMNAME|P}} value and a smooth movement in all motor positions.
 
The video shows the procedure. After five seconds, {{PARAMNAME|P}} and {{PARAMNAME|I}} are set to non-zero values and the gimbal moves into a level position. Then the {{PARAMNAME|P}} value is increased. Once P = 15 is reached, some weird shakes start to appear when the motor is released from a tilted position, which get worse and worse, and with P = 23 the camera shakes for a while even. Only once the {{PARAMNAME|P}} value is set back to 13 a smooth movement from all positions is achieved again.


{{#ev:youtube|O_FC6S_Lpgs}}
{{#ev:youtube|O_FC6S_Lpgs}}


=== The I-Parameter ===
=== The I Parameter ===
 
Now the {{PARAMNAME|I}}ntegral term can be adjusted. The goal is, similar to the other parameters, to find the largest possible value without introducing negative side effects.
 
In fact, the {{PARAMNAME|I}} term plays a much more important role for the stabilization accuracy than the {{PARAMNAME|D}} and {{PARAMNAME|P}} parameters. In practical terms this means, that it is more important to set a large {{PARAMNAME|I}} value, or vice versa, that one doesn't loose too much if {{PARAMNAME|D}} and {{PARAMNAME|P}} are not at their highest possible values. So, it is actually not a bad idea to lower {{PARAMNAME|D}} and {{PARAMNAME|P}}, as this increases e.g. the reliability of the PID controller behavior.


Now we want to set {{GUI|I}} to the maximum value possible without introducing any side effects. If you look carefully at the last few seconds of the previous video, when {{GUI|I}} was at 5 still, the camera could not be kept level when the gimbal itself was moved. The {{GUI|I}}ntegral term (integral over the time) is responsible for this part of the movement.  
When you look carefully again at the last few seconds of the previous video, where {{PARAMNAME|I}} was 5, you'll see that the camera could not be kept level when the gimbal was moved. The {{PARAMNAME|I}} term is responsible for this part of the movement.  


In the video below the {{GUI|I}} value is increased to 480 initially and in comparison you can see the same movement with I = 5. Perfect movement now, fast speed, the camera remains horizontal, it truly is horizontal, everything fine. But maybe we can increase it even further. At 700 the same situation, everything looks nice. But at I = 1200 you can see that the camera no longer is horizontally aligned, the "time" aspect of the control loop starts to overcompensate. If you look carefully at the yellow cable of the IMU connector, it is vibrating - sorry, not very visible in the video. So 1200 is a too high value for sure. There were slight vibrations in some positions of the camera at 700 even, so {{GUI|I}} got set to 620 at the end.
In the video, the {{PARAMNAME|I}} value is initially set to 480. I in comparison to the behavior for I = 5, a perfect movement is now obtained: fast speed, the camera remains horizontal, it truly is horizontal, everything is fine. Maybe one can increase {{PARAMNAME|I}} even further. At I = 700 the same situation, everything looks nice. At I = 1200, however, the camera isn't horizontally aligned, and - if you look carefully at the yellow cable of the IMU connector - you see that it is vibrating (sorry, not very visible in the video). So, I = 1200 is too high for sure. There were slight vibrations in some positions of the camera even at I = 700, so {{PARAMNAME|I}} was set to 620 at the end.


{{#ev:youtube|kGFhd7Q4vgw}}
{{#ev:youtube|kGFhd7Q4vgw}}


== Repeat above 5 steps ==
== Repeat for all Axes ==
 
The above procedure should be started with the pitch axis, and then repeated for the roll axis, and finally for the yaw axis.
 
The yaw axis has to handle the largest weight. Accordingly, the motor power needs usually to be higher than for the pitch and roll axes, that is either the {{PARAMNAME|Yaw Motor Vmax}} value is higher, or a larger motor is used.
 
You might find that then you tune e.g. the roll axis, that the pitch axis doesn't perform as well as with disabled roll motor. This is common. It is mainly due to imperfect balancing, but it's essentially impossible to avoid. Simply "down-tune" the pitch axis, i.e. reduce the PID values a bit until things are good again. Similar holds obviously when tuning the yaw axis.
 
== Next Step - RC Inputs ==


First with the roll axis and at the end with the yaw axis. Yaw is somewhat differently as there is no "horizontal" or zero position in yaw. And because the yaw axis has to carry the most weight, the power values are usually higher there, or a larger motor is used.
You should have now a self-stabilizing gimbal. No matter what movements the gimbal support is undergoing, the camera remains stable in position.  


== Next step - RC Inputs ==
If so, you may want to set the yaw axis back to pan mode. In the {{GUI|Pan}} tab set the {{PARAMNAME|Yaw Pan}} value to a non-zero value (default is 2.0) and the {{PARAMNAME|Pan Mode Default Setting}} to "hold hold pan".


With these settings we have a self leveling gimbal. No matter what movements the gimbal support is undergoing, the camera remains stable. While this might be perfectly sufficient for basic operation, normally the gimbal shall also be moved via a RC stick or, on a hand-held gimbal, via a joystick, or functions such as switching between hold and pan modes or releasing the shutter of the camera remotely are desired.
While the current setting might be perfectly sufficient for basic operation, normally the gimbal shall also be moved via a RC stick or a joystick, or functions such as switching between hold and pan modes or a pan deadband are desired.


You can learn about these possibilities in the next chapters; continue with [[Configure the RC Input]].
You can learn about these possibilities in the next chapters; continue with [[Configure the RC Input]].

Latest revision as of 15:46, 14 September 2015

by Yang/wdaehn, with edits by OlliW

A major problem for people new to brushless gimbals is finding the correct values of the PID parameters. A PID controller is a well known and often used method for calculating a new input value by measuring the difference between the current state and a target state, and applying a formula to the difference. In theory, after the calculation is applied, the target state would be reached immediately, but in reality it is not, because e.g. the motor is not indefinitely fast. So in the next iteration there is still an error, smaller but it exists, and an improved input value is calculated based on the new difference between actual and target states.

Due to this iterative approach the control loop can react precisely to any kind of distortions, but all sorts of bad things might happen if the formula is wrong. For example, the camera might look down by 15°, and our formula might be: motor power = 15° * 2 W/°. With this amount of power the motor will rotate 30° upwards, instead of the desired 15°, and the camera will look up by 15°. Thus, in the next iteration, a motor power of -15° * 2 W/° is calculated, and the direction is reversed. The resulting effect would be a shaking of the motor and camera between the +15° and -15° positions. The formula used by a PID control algorithm is more advanced than in this example, and is optimized for quick reaction without overshooting the target position (too much). But even then, when the parameters are wrong, one gets all kinds of weird movement patterns.

See Wikipedia for further details on PID control.

Below a relatively simple and straight forward tuning technique is suggested, which often works surprisingly well, and has a theoretical foundation. However, it may also fail. In fact, it is important to realize that some gimbals might not be tunable at all, because e.g. too weak or too strong motors are used, and other reasons. As a rule of thumb: When you don't get a good tuning within 10 min (per axis) then chances are that something is wrong with the gimbal design. There ain't no such thing as a hard to tune gimbal. There are just well and badly designed gimbals.

Balancing the Gimbal

Before any tuning, the gimbal needs to be balanced. Balancing means to bring the center of gravity (COG) of the mounted camera into the center of all three gimbal motor axes (depending on the gimbal construction it is also part of the balancing to ensure that all three gimbal motor axes cross in one point). A quick test, which may be sufficient for larger cameras, is to move the camera by hand while all gimbal motors are turned off: The camera should remain in its position whenever you let it go, as demonstrated in the video below.

A perfectly balanced gimbal has many advantages. Otherwise you will get artefacts:

  • When the gimbal as a whole is accelerated, the camera would rotate out of position due to residual forces - see the image below.
  • The motors need to apply more power to keep the camera in position.
  • When turning the camera, e.g. with the RC stick, the center of gravity would change its positions with respect to the center of the gimbal motor axes.
  • The PID control actions on different axes get correlated.
  • Vibrations in the gimbal are more easily induced.

Balancing not only brings advantages, a minimu degree of balancing is in fact mandatory for the gimbal and controller to function at all. It's as simple as that: The better the balancing the better the gimbal performance. This holds true especially for a 3-axis gimbal.

You will always have to compromise, because e.g. the gimbal does not allow for infinitely precise adjustments, or because of friction in the motors, and so on. Hence take considerable effort in balancing the gimbal as good as possible, but at some point one of course has to let go.

The picture below shows a very badly balanced situation. The center of gravity is quite below the pitch motor axis. At first this might actually look like a good idea, since the camera gets "self-stabilized" by gravity. However, consider now the gimbal being accelerated to the right. Because the center of gravity is below the pitch axis, where would be a force on the camera and it would tilt downwards. The PID controller would have to fight against that, which makes it much harder or even impossible for it to stabilize the camera.

The video shows a well balanced gimbal. Here it is possible to move the camera to any orientation and let it free, without it turning back to a preferred orientation.

Please also consider these tips:

  • It is important to electrically disconnect the motors from the board, since then they can rotate more freely than just being disabled in the GUI.
  • A much more severe test to check balance is to heavily shake the gimbal, up and down, left and right, forward and backward. When balanced, the camera will stay in the position it was before the shaking started. Do this for different camera positions.
  • A 3-axis gimbal requires more precise balancing than a 2-axis gimbal. Especially the yaw axis needs attention.
  • In general, the smaller the camera the more important is the balance.

DSC 7111.jpg

Tuning Procedure

The tuning of one axis might impact the other axis, so it is best to tune one axis after the other. Accordingly, the first step in tuning a brand new gimbal is to disable all motors except of the pitch motor, and find the proper tuning parameters for it. Then the roll motor is enabled and the corresponding PID parameters are tuned. Finally, the yaw axis is done.

Our goal in the PID tuning is to find the highest value for each of the P, I and D parameters which still work stably. The higher the values the better distortions can be compensated, and the more accurate the camera will be hold in position. If a value however is too large, then the PID controller will overcompensate, and we will notice oscillations, noise, or even erratic behavior in the worst case.

To find the sweet point we will start with a low value, increase it until the gimbal starts to misbehave, and move back until it works again. This will be done first for the D parameter, when the P value, and last but not least the I term.

Before that, we will have to set the Motor Vmax parameter, which also affects the tuning. Fortunately, it is relatively easy to adjust and not too critical (unless the gimbal tends to vibrations at certain gimbal postions).

The procedure is illustrated below also by videos.

Further tips:

  • A parameter setting may be double-checked by turning the motors by hand into all allowed positions. This has less to do with the PID regulation by itself, but tests whether the current parameter values work well in all positions. If the gimbal and camera would be balanced perfectly, then there wouldn't be a need to do that, but, reality ...

Storm32-wiki-imu-pid-01.jpg

The Starting Point

Set the P, I and D values to zero.

Also, ensure that:

  • All three axes should be in hold mode, i.e., in the [Pan] tab the parameters Pitch Pan, Roll Pan and Yaw Pan should be set to zero or alternatively the Pan Mode Default Setting set to "hold hold hold".
  • Voltage Correction should be set to 0%.
  • A 2nd IMU should be deactivated, i.e., in the [Setup] tab the parameter Imu2 Configuration should be set to "off".
  • The battery should neither be fully charged nor nearly discharged, i.e., have a voltage of about 3.7 V per cell.

Setting Motor Vmax

The Motor Vmax parameter, or Vmax in short, determines the amount of energy applied to the motor. It should be large enough, such that the motor has enough strength to hold the camera in position, but on the other hand should not be that large that the motor overheats.

To determine the required motor power, turn the motor by hand against the motor's momentum and predict how much force will be needed to hold the camera in a steady position at any time. In the example video, the starting value for Vmax is 190, and the motor shows a clear resistance to any manual movement. With the value reduced to 55, the motor can be turned almost freely. In fact, it does not even has enough power to keep the current position - so much about my gimbal is balanced perfectly, right? Finally the behavior is shown with Vmax set to the maximum value of 255.

In principle, using the maximum value would be okay, except that it is a waste of battery power and the motor might get hot. Also, with larger Vmax stronger micro motions of the motor are produced and, depending on the gimbal, the gimbal may more easily develop vibrations.

Therefore the advice is to define a useful low Vmax value.

Comment: A common misconception is that the motor needs to work only against the forces/torques due to an improperly balanced gimbal, and that one thus can get away with smaller motor power or motors if only the gimbal is very well built. However, if one wants to move the camera with the stick or wants the camera to follow the gimbal (pan mode), then the motor has to work also against the mass momentum of the camera. Unpredictable dynamic forces such as wind and so on come in additionally. Keep all of that in mind when estimating the amount of force the motor should apply to the camera.

The D Parameter

With P and I set to zero, there is no position correction at all, that is the motor will simply stay in its current position.

The Derivative term of the PID control loop is not directly related to the movement of the camera. It is a high frequency correction looking ahead, in order to dampen what in future could become oscillations. If the D value is too high, then the frequency of the correction gets visible and/or audible. Therefore, by keeping P and I zero and just increasing D, one can find a point at which an audible high-frequency noise, produced by the gimbal motor, appears. The D value should be as large as possible without any noise occuring. Once a good value is found, one should move the motor by hand to doublecheck that no noise appears for any gimbal position. If a D value is working great in almost all positions except one, then that would be indication of an imperfectly balanced gimbal. Go then back to start.

An example tuning is illustrate in the video. Listen to it (switch on audio). Initially D = 0.17, and the gimbal is shaking like mad, with low frequency and high amplitudes. Then the value is reduced to D = 0.10, and the camera position becomes stable, but a high-frequency noise can clearly be heard. With D = 0.05 the frequency gets even higher. We want the frequency to be that high that no noise is audible. At D = 0.04 the noise is suddenly gone.

Before the video was taken, the following actually happened. First D = 0.04 was picked, and everything was fine. With increasing it to 0.05, everything was still fine. At D = 0.06 heavy vibrations were visible, hence the previous D = 0.05 value was set, but now vibrations were still present! In this situation one could manually move the motor into a different position and the vibrations would go away. What happened? At D = 0.06 the resonance frequency of the control loop was hit, but with a slight decrease to 0.05 the frequency remained very similar and the control loop was not able to get out of it by itself. So, to be on the safe side D = 0.04 was chosen, as for this value the shaking stopped by itself. The message is that it's quite natural to observe a hysteresis, that is that when coming from large D values one needs to go to smaller D values to stop a vibration than the other way around. Choose the smaller D value, at which the vibrations stop.

Comment: In the GUI you can move the slider also using the cursor keys. Click on the slider handle with the mouse, and hit the left/right key to change the value by its minimal step width. Very useful, especially for adjusting D.

The P Parameter

Before starting the tuning of the Proportional term of the PID controller, set the I parameter to a low value, for instance 5, which is the lowest non-zero value.

The P constant is multiplied with the positional error to get the correction amount, exactly as in the example discussed in the introduction. The higher the P factor is the larger the calculated correction will be. If it is too high, then the PID controller will have the tendency to overshoot the target position, and when it is much too high it even produces totally erratic movements. Hence, the goal is to have both a high P value and a smooth movement in all motor positions.

The video shows the procedure. After five seconds, P and I are set to non-zero values and the gimbal moves into a level position. Then the P value is increased. Once P = 15 is reached, some weird shakes start to appear when the motor is released from a tilted position, which get worse and worse, and with P = 23 the camera shakes for a while even. Only once the P value is set back to 13 a smooth movement from all positions is achieved again.

The I Parameter

Now the Integral term can be adjusted. The goal is, similar to the other parameters, to find the largest possible value without introducing negative side effects.

In fact, the I term plays a much more important role for the stabilization accuracy than the D and P parameters. In practical terms this means, that it is more important to set a large I value, or vice versa, that one doesn't loose too much if D and P are not at their highest possible values. So, it is actually not a bad idea to lower D and P, as this increases e.g. the reliability of the PID controller behavior.

When you look carefully again at the last few seconds of the previous video, where I was 5, you'll see that the camera could not be kept level when the gimbal was moved. The I term is responsible for this part of the movement.

In the video, the I value is initially set to 480. I in comparison to the behavior for I = 5, a perfect movement is now obtained: fast speed, the camera remains horizontal, it truly is horizontal, everything is fine. Maybe one can increase I even further. At I = 700 the same situation, everything looks nice. At I = 1200, however, the camera isn't horizontally aligned, and - if you look carefully at the yellow cable of the IMU connector - you see that it is vibrating (sorry, not very visible in the video). So, I = 1200 is too high for sure. There were slight vibrations in some positions of the camera even at I = 700, so I was set to 620 at the end.

Repeat for all Axes

The above procedure should be started with the pitch axis, and then repeated for the roll axis, and finally for the yaw axis.

The yaw axis has to handle the largest weight. Accordingly, the motor power needs usually to be higher than for the pitch and roll axes, that is either the Yaw Motor Vmax value is higher, or a larger motor is used.

You might find that then you tune e.g. the roll axis, that the pitch axis doesn't perform as well as with disabled roll motor. This is common. It is mainly due to imperfect balancing, but it's essentially impossible to avoid. Simply "down-tune" the pitch axis, i.e. reduce the PID values a bit until things are good again. Similar holds obviously when tuning the yaw axis.

Next Step - RC Inputs

You should have now a self-stabilizing gimbal. No matter what movements the gimbal support is undergoing, the camera remains stable in position.

If so, you may want to set the yaw axis back to pan mode. In the [Pan] tab set the Yaw Pan value to a non-zero value (default is 2.0) and the Pan Mode Default Setting to "hold hold pan".

While the current setting might be perfectly sufficient for basic operation, normally the gimbal shall also be moved via a RC stick or a joystick, or functions such as switching between hold and pan modes or a pan deadband are desired.

You can learn about these possibilities in the next chapters; continue with Configure the RC Input.