Using STorM32 with ArduPilot

From STorM32-BGC Wiki
Revision as of 18:57, 9 December 2019 by OlliW (talk | contribs) (→‎BetaPilot)
Jump to navigation Jump to search

The information on this page refers to firmware v2.48e and BetaPilot 4.0 v002, and higher.

The STorM32 gimbal controller can communicate with an ArduPilot flight controller via a serial UART data line. The serial communication allows for a much richer data transmission and accordingly richer set of features than possible with the traditional PWM connections. Examples are advanced control functions, the STorM32-Link or the NT Camera features. It also can lead to a much cleaner wiring.

If you just need the range of functionality possible with the standard tilt & pan control, then you don't need anything of the following, and you may stop reading here. Also, some of the features discussed below can be accomplished by workarounds. Decide yourself which approach fits your needs best. :)

STorM32 - ArduPilot Support

ArduPilot offers two mount types, which can be used with the STorM32 controller, the SToRM32 MAVLink (MNT_TYPE = 4) and SToRM32 Serial (MNT_TYPE = 5) mounts. For further details please visit ArduPilot Docs > Copter > Optional Hardware > Camera&Gimbals > SToRM32 Gimbal Controller.

Comment: Unfortunately, ArduPilot's gimbal support is partially flawed. That is, many features you will find to work great, but some you will find to not work well. STorM32 can't do anything about it, it's ArduPilot. Please also note that the STorM32 firmware author is not responsible for the implementation of the above mounts; again, it's ArduPilot.

The BetaPilot fork of ArduPilot additionally offers the STorM32 MAVLink2 (MNT_TYPE = 83) mount type, which provides the best range of functions.

A comparison of the different techniques to connect the STorM32 controller with the flight controller is given in the following feature matrix.

Feature Matrix

(to the best of the authors knowledge)

Feature PWM SToRM32 MAVLink SToRM32 Serial STorM32 MAVLink2
Gimbal Angle Control x x (?) x x
Solo Smart Shots x - - x
MAV_MOUNT_STATUS message - x (1) x (2) x
Camera Trigger x x (?) - x
Gimbal Point in MP - x (?) x x
Video on/off - - - x
360° Gimbal with Free Look - - - x
STorM32 Functions - - - x
STorM32 Scripts - - - x
STorM32-Link: Horizon Drift Comp. - - - x (3)
STorM32-Link: Yaw Drift Comp. - - - x (3)
Passthrough Configuration - - - x
Camera Micro Service - - - x

(?) May or may not work properly in the latest ArduPilot releases. Please check with the ArduPilot community.

(1) The message reports the last set point, not the actual gimbal/camera orientation.

(2) Works only for deprecated v0.xx firmwares.

(3) Works only for T-STorM32 gimbals.

BetaPilot

Some modifications to the ArduPilot firmware were made and the result called BetaPilot, which provides simply the best support of STorM32 gimbals.

Comments:

  • If you are satisfied with ArduPilot's gimbal support then there is really no need to use BetaPilot. However, if you want to make best use of STorM32 and want 2019-ish capabilities then you seriously want to chose BetaPilot.
  • Before using BetaPilot it is strongly recommended to first install the original ArduPilot firmware and get the copter/plane flying flawlessly with it, and only then to install BetaPilot.

In order to establish a working communication between the STorM32 controller and the flight controller, parameters on both sides, BetaPilot and STorM32, need to be adjusted, as described in the following.

The BetaCopter fork implements the STorM32 MAVLink2 mount type, which handles all of the following features. If the STorM32 MAVLink2 mount is not activated, then the BetaPilot firmware will behave exactly like the original ArduPilot firmware, with no side effects.

STorM32 Native via UART Port

The STorM32 board needs to be connected via one of its UART ports or the USB port to one of the UART ports on the ArduPilot flight controller, and these settings be made:

Settings in BetaCopter:

  • MNT_TYPE = 83
  • SERIALx_PROTOCOL = 83
  • SERIALx_BAUD = 115

Settings in STorM32:

  • Mavlink Configuration = “no heartbeat”

With the mount activated, you should notice:

  • All ArduCopter mount features such as gimbal control, POI, follow me, smart shots, and so on, are working.
  • All ArduCopter camera features are working. That is, whenever a certain path of actions (Mavlink, receiver, mission, UAVCAN, ...) lets ArduCopter want to take a picture, the STorM32 controller will know and activate its camera functions.
  • In the Message box of MissonPlanner "STorM32 ..." messages will appear.
  • The STorM32-Link, providing horizon drift and yaw drift compensation, and additional features, is present.

Comment: The default baudrate of the STorM32 serial ports is 115200 bps, hence in ArduPilot SERIALx_BAUD has to be set to 115. However, other baudrates can be configured; for e.g. 230400 bps one sets the STorM32 parameter Uart Baudrate to “230400” and the ArduPilot parameter SERIALx_BAUD to 230.

STorM32 Native via UAVCAN

The STorM32 can also be connected via the CAN bus to the ArduPilot flight controller. This option is however mentioned here only for completeness (details of the STorM32's UAVCAN support are described in the article UAVCAN).

STorM32-Link

Parameter in STorM32:

  • STorM32Link Configuration = “v1”

With MNT_TYPE = 83 also the STorM32-Link is activated (for details see STorM32-Link). That is, in addition to the 'conventional' data also the data required for the functioning of the STorM32-Link are emitted by the flight controller. The parameter STorM32Link Configuration set to “v1” makes the STorM32 using them. In the STorM32 GUI, specifically the [GUI:Dashboard] and/or the [GUI:Data Display], you should note that the STorM32-Link field goes to INUSE and OK.

Comment: If only the 'conventional' data but not the STorM32-Link data are received by the STorM32 controller, then an ISPRESENT and/or OK will be displayed to indicate that a working link has been established between STorM32 and BetaCopter, and that the 'conventional' control functions are all working. The INUSE flag will not appear, which indicates that the STorM32-Link, i.e., the horizon and yaw drift compensation feature, is not active.

Comment: The STorM32-Link is available only for T-STorM32 gimbals, but not the conventional STorM32 NT gimbals.

STorM32: Virtual Channel Configuration

Parameter in STorM32:

  • Virtual Channel Configuration = “serial”

With this setting, all STorM32 functions can be invoked by selecting any of the “Virtual-1” - “Virtual-16” input channels, exactly as one would do if the STorM32 controller would be directly connected to the receiver. This allows doing many useful things, such as activating a script or triggering video on/off from the transmitter. It however also allows doing nonsense, and it is the users responsibility to avoid that. For instance, if the ArduPilot mount is activated and is in Rc Targeting mode, and e.g. Rc Pitch Control is set to a virtual input channel, then the gimbal may move in funny ways since it may receive the transmitter stick information from both the ArduPilot mount and the receiver. In contrast, if the ArduPilot mount is in GPS or ROI Targeting mode, then one gets "free look", which is useful and quite cool actually. As said, all this is exactly as if the receiver would be directly connected to the STorM32 controller on its RC ports.

RC Targeting

Parameter in BetaCopter:

  • MNT_STRM_BM

The BetaCopter parameter MNT_STRM_BM, which is a bit mask, allows us to enable/disable various functions. Especially the behavior of the RC Targeting mode can be modified. By setting the 1-st bit of MNT_STRM_BM, that is by adding +1 to the current value, the RC Targeting is determined now by the STorM32 parameters in the [GUI:Rc Inputs] tab. This especially allows us to set a relative mode.

Passthru Configuration

Parameter in BetaCopter:

  • MNT_STRM_PTSER

This feature allows you to connect the STorM32 GUI to the USB port of an ArduPilot flight controller, or in fact to any of its serial ports, or the UAVCAN bus, and to directly communicate with the STorM32 gimbal. This is extremely convennient for configuring STorM32 gimbals when e.g. installed permanently in the flight vehicle. This also works via a wireless telemetry link, and thus opens the option of e.g. tuning the gimbal during flight, and further unheard of possibilities for controlling the gimbal during flight.

These two video demonstrate this feature, and also explain the setup:

Comment: In BetaCopter v0.10 and higher, by default the passthru communication is disabled when the flight controller is armed, and e.g. in-flight configuration would not work. This protection can be disabled by setting the 7-th bit in the MNT_STRM_BM parameter, by adding +64 to its value.

Testing the Connection

The serial/UAVCAN connection can be tested in several ways. The following tests do not require that the copter is completely built, and do not require that the copter is armed.

  • STorM32-Link field in the STorM32 GUI: The [GUI:Dashboard] and [GUI:Data Display] each have a field which is related to the STorM32-Link. They should display OK, PRESENT or a similar positive message.
  • Message box in MissonPlanner: In the message box several messages related to the STorM32 should appear. In particular, a message like "STorM32 v2.40 nt v1.30 F103RC" informing about the STorM32 firmware version should be visible. Also, a message "STorM32 in NORMAL mode" should occur when the gimbal has finished initialization and entered NORMAL mode.
  • Trigger Camera NOW: In MissionPlanner the camera can be triggered by a right-mouse-click dropdown menu in the Flight Data map. On the STorM32 side the camera trigger can be easily tested by connecting a visible-light LED (red, green, blue, not IR) to the #IR port.
  • Gimbal RC Targeting: With the ArduPilot mount in RC Targeting mode (which should be the default setting), the camera can be moved with the transmitter sticks.
  • Sniffing the communication: One of course can sniff directly what is going on on the communication data lines. This is especially helpful when using CAN/UAVCAN. You when need a SLCAN adapter, e.g., the UC4H SLCAN adapter.

Gimbal Point

MissionPlanner supports what it calls a gimbal point. It is a blue point icon on the map, which indicates the estimated position at which the gimbal is looking at (see also e.g. https://github.com/ArduPilot/MissionPlanner/issues/1323). In order to activate it, the following ArduPilot parameters must be set:

Settings in ArduPilot:

  • MNT_STAB_ROLL = 0
  • MNT_STAB_TILT = 1
Retrieved from "http:///storm32bgc-wiki/index.php?title=Using_STorM32_with_ArduPilot&oldid=8550"