Using a 2nd IMU: Difference between revisions

From STorM32-BGC Wiki
Jump to navigation Jump to search
Line 8: Line 8:
It must not be mounted on one of the gimbal axes or the camera platform.  
It must not be mounted on one of the gimbal axes or the camera platform.  


So you can either mount the controller board on the gimbal support using the on-board IMU as 2nd IMU, or put the controller board somewhere else (on the yaw axis for example) and mount an external IMU module above the yaw motor. These two options are shown as option (1) and (2) in the diagram below.
So, you can either mount the controller board on the gimbal support, and then use the on-board IMU as 2nd IMU, or you put the controller board somewhere else (on the yaw axis for example) and mount an external IMU module above the yaw motor. These two options are shown as option (1) and (2) in the diagram below. Option (3) is {{WARNING|'''''not'''''}} supported by the STorM32.


The external IMU module would be connected to the I2C#2 connector on the bottom side of the STorM32 board. Doing so automatically selects the external IMU module as 2nd IMU. If no IMU module is connected to I2C#2, the on-board IMU is selected. So you don't have to change anything in the GUI, the external IMU module is used automatically when connected.
The external IMU module can be either a NT imu module or a "traditional" i2c-based MPU6050 board. The NT imu module would be connected, like all NT modules, to the NT bus. Its ID solder bridge must be closed. An external i2c-based IMU would be connected to the I2C#2 connector on the bottom side of the STorM32 board.  


{{COMMENT|The on-board mpu6050 IMU is connected to the I2C#2 connector internally and is set to a non default i2c address. If you connect an external (i2c-based) mpu6050 IMU to the I2C#2 connector, then it can be recognized by its default i2c address, and is selected instead of the on-board IMU. }}
Which IMU is selected as 2nd IMU is determined by the STorM32 controller as follows:
* If a NT imu module configured as Imu2 (ID solder pad closed) is found on the NT bus, then it will be used as 2nd IMU.
* If an NT imu module is not found, but an i2c-based IMU is found at the I2C#2 connector, then it will be used as 2nd IMU.
* If neither of the above, then the on-board IMU will be used as 2nd IMU.


{{COMMENT|{{WARNING|Configuration (3) in the diagram is '''not''' supported by the STorM32}}. By principle it provides only very limited benefits}}.
{{COMMENT|The on-board mpu6050 IMU is connected to the I2C#2 connector internally and is set to a non default i2c address. If you connect an external i2c-based IMU to the I2C#2 connector, then it can be recognized by its default i2c address, and is used instead of the on-board IMU. }}
 
In order to make use of a 2nd IMU, it needs to be activated


[[File:Storm32-wiki-2nd-imu-configurations-01.jpg|640px|center]]
[[File:Storm32-wiki-2nd-imu-configurations-01.jpg|640px|center]]

Revision as of 14:27, 31 March 2016

The STorM32 controller allows the use of a second IMU (2nd IMU), in addition to the camera IMU mounted to the camera platform, for superior performance. It's usage and advantages are described here.

Installation Options

The primary rule for installation is:

The 2nd IMU must be mounted on the gimbal support above the yaw motor so it is not moved by any of the motors. 

It must not be mounted on one of the gimbal axes or the camera platform.

So, you can either mount the controller board on the gimbal support, and then use the on-board IMU as 2nd IMU, or you put the controller board somewhere else (on the yaw axis for example) and mount an external IMU module above the yaw motor. These two options are shown as option (1) and (2) in the diagram below. Option (3) is not supported by the STorM32.

The external IMU module can be either a NT imu module or a "traditional" i2c-based MPU6050 board. The NT imu module would be connected, like all NT modules, to the NT bus. Its ID solder bridge must be closed. An external i2c-based IMU would be connected to the I2C#2 connector on the bottom side of the STorM32 board.

Which IMU is selected as 2nd IMU is determined by the STorM32 controller as follows:

  • If a NT imu module configured as Imu2 (ID solder pad closed) is found on the NT bus, then it will be used as 2nd IMU.
  • If an NT imu module is not found, but an i2c-based IMU is found at the I2C#2 connector, then it will be used as 2nd IMU.
  • If neither of the above, then the on-board IMU will be used as 2nd IMU.

Comment: The on-board mpu6050 IMU is connected to the I2C#2 connector internally and is set to a non default i2c address. If you connect an external i2c-based IMU to the I2C#2 connector, then it can be recognized by its default i2c address, and is used instead of the on-board IMU.

In order to make use of a 2nd IMU, it needs to be activated

Storm32-wiki-2nd-imu-configurations-01.jpg

Calibration

As with the camera IMU, also the 2nd IMU, be it the on-board IMU or an external IMU module, needs to be calibrated for optimal performance.

However, fortunately, for the 2nd IMU it's not critical to get the most accurate calibration, and a good 1-point calibration should be enough for most situations. Exceptions are then motors with high motor pole counts, larger than 14, are used.

The calibration of the 2nd IMU works similar to the camera IMU; one just has to select the 2nd IMU in the respective fields.

IMU Orientation

For a correct functioning it is very important to set the IMU orientation correctly, i.e., the parameter field Imu2 Orientation in the [GUI:Gimbal Configuration] tab.

This is most conveniently achieved by using the [GUI:Configure Gimbal Tool]. Alternatively, it may be set manually following the recipe described in Manually Setting the IMU Orientation.

Yaw Axis Alignment

It is also very important to ensure that at startup the camera is aligned properly with respect to the gimbal support; it needs to point forward to within a degree or so.

This is most conveniently achieved by using the [GUI:Configure Gimbal Tool], which in one step allows you to adjust the camera orientation. Alternatively, the yaw axis orientation at startup may be adjusted manually by setting the Yaw Startup Motor Pos parameter in the [GUI:Gimbal Configuration] tab.

Comment: It is not required to orient the camera precisely by hand before the controller is switched on. Here it is sufficient to have the camera aligned to within typically +-25° (for a 14 pole yaw motor). However, when the controller is powered up, it first moves the motors to default startup positions, and after this step the camera must precisely point to the forward.

IMU Configuration

The 2nd IMU support is determined by the parameter Imu2 Configuration found in the [GUI:Setup] tab. To activate the 2nd IMU, set it to

  • “full”: activate 2nd IMU above the yaw motor
  • “full xy”: activate 2nd IMU above the yaw motor, with the IMU rotated by 45°.

PID Tuning

The initial PID tuning should be done with the 2nd IMU deactivated.

If, after the initial PID tuning, the 2nd IMU is activated, then the gimbal often works "out of the box", but sometimes the PID values might have to be slightly readjusted. The reasons are the imperfections in the gimbal, such as the balance, the motor quality or insufficiently stiff gimbal arms. With the 2nd IMU activated the controller is much faster and can compensate gimbal motions much better, as a view on the [GUI:DataDisplay] impressively demonstrates. The downside is that imperfections get amplified. Especially the balance of the yaw axis and play in the motor bearings are typical culprits.

If these points cannot be further improved, it can be very successful to down-tune the roll and yaw PID controllers, i.e., to reduce their values. You need to experiment. The control precision is then reduced, but since with 2nd IMU it is much higher anyhow it overall will be still better. Further points to try is to test different values for Gyro LPF, and/or change the Motor Vmax values by some digits.

Benefits of a 2nd IMU

Nowadays advanced brushless gimbal controller provide 2nd IMU support, but there are marked differences in how and to what extend the 2nd IMU is used. The STorM32 controller is - to the best of the knowledge of the firmware author - unique in that it provides (i) a stable operation with the 2nd IMU above the yaw motor and (ii) a distortion rejection for the yaw axis also in the pan/follow mode. Usually these features would require the installation of a poti or angle encoder on yaw.

The benefits provided by the STorM32's 2nd IMU support are

  • significantly improved accuracy, i.e., the camera is held in position with a much smaller error bandwidth
  • drastically larger range of operation, essentially any pitch and yaw angle is possible (for a more detailed discussion of the possibilities and limitations see here)
  • stable operation of the 2nd IMU above the yaw axis without deterioration over time due to gyro drift
  • returns to the correct yaw orientation after an external distortion, also when in pan/follow mode

These features were demonstrated in this video for an early test version of the firmware (the features became better since then):