Using STorM32 with BetaPilot
The information on this page refers to firmware v2.65b and BetaPilot (BetaCopter/BetaPlane) 4.3.3 v0.55, and higher.
The STorM32 gimbal controller can communicate with ArduPilot flight controllers via a serial UART data link using the MAVLink protocol. The serial communication allows for a much richer data transmission and accordingly richer set of features than possible with the traditional connections such as PWM, PPM, SBUS, CRSF, and alike. Examples are advanced control functions, the STorM32-Link or the NT Camera features. It also can lead to a much cleaner wiring and a more robust and reliable system.
The ArduPilot firmware is unfortunately notoriously unpleasant as regards its gimbal and camera support (flaws, not MAVLink standard conform, etc.), and thus BetaPilot was started many years ago.
BetaPilot, which includes BetaCopter and BetaPlane, is a fork of ArduPilot, with modifications which are specifically directed at the STorM32 gimbal controller. If you want to make best use of your STorM32 gimbal and want 2020-ish capabilities, then you definitely want to chose BetaPilot (BetaCopter/BetaPlane). :)
This article is about BetaPilot. For info on using the native ArduPilot firmware with STorM32, please visit the article Using STorM32 with ArduPilot.
BetaPilot
BetaPilot implements the latest MAVLink standard and in particular the STorM32 MAVLink2 mount type (MNTx_TYPE = 83), which make the features below possible.
In order to establish a working communication between the STorM32 controller and the flight controller, a serial connection needs to be established, and parameters in both the flight controller and the STorM32 controller need to be adjusted, as described in the subsequent chapters.
BetaPilot is currently available for copters and planes. The code additions are however such that it should be trivial to extend to other vehicles supported by ArduPilot. BetaPilot currently comes in these branches:
- BetaCopter4.3: This is based on ArduCopter 4.3.3-rc1, and is hence the go-to version for copter users.
- BetaPlane4.3: This is based on ArduPlane 4.3.3-beta1, and is hence the go-to version for plane users.
- BetaPilot branch: This is based on ArduPilot master, which is ArduPilot's development branch (= not stable). The support of the BetaPilot branch is not steady but on and off. Typically, the BetaPilot branch is progressing when required features are in master but not in the stable or beta/rc branches, but usually it tends to lack behind, possibly even quite a bit.
Comment: The label 'BetaPilot' is used in the following as shorthand for denoting the project or referring to BetaCopter or BetaPlane, and not to refer to the BetaPilot branch.
Firmware Binaries
For BetaCopter and BetaPlane, ready-to-use firmware binaries are provided for some few boards in the 'bp_compiled_binaries' folders:
For other boards, the respective source code needs to be compiled by the user (or you ask in the rcgroups thread to maybe help you out). For instructions on how to compile BetaCopter or BetaPlane, please consult the github repository, https://github.com/olliw42/BetaPilot/wiki.
For installing/flashing the binary follow the common instructions for installing custom firmware. In MissionPlanner, e.g., go to 'Setup -> Install Firmware -> Load custom firmware'.
COMMENT
Before using BetaCopter/BetaPlane, it is strongly recommended to first install the original ArduCopter/ArduPlane firmware and get the vehicle operating flawlessly with it. Only then install BetaCopter/BetaPlane.
The additions by BetaCopter/BetaPlane to the main code are minimally infectious, meaning that they do not have impact on normal behavior. It is usually no problem at all to swap the firmware between ArduCopter/ArduPlane and BetaCopter/BetaPlane, which can help sort out issues in case of doubt of the origin of an issue. The main impact of BetaCopter/BetaPlane is a slightly increased flash and RAM footprint, which can have effects on boards which are short of flash and/or RAM. That's a general problem with this kind of boards.
STorM32 MAVLink2 Mount Type
The STorM32 controller needs to be connected via one of its serial ports to one of the serial ports on the flight controller, and these settings in both STorM32 and BetaPilot need to be made:
Settings in STorM32:
- Mavlink Gimbal = “Gimbal1” or higher
- Mavlink Gimbal Stream = “mountstatus” or higher (the typical setting would be “device status” or “manager status”)
- Mavlink Uart Port = “uart” if the serial port UART is used (this is the default)
- Mavlink System ID = “0” for auto-detection (which is the default) or system ID of autopilot
Other MAVLink-related settings can normally be left at their default. A complete description of the parameters is provided in MAVLink Communication: Parameters (please read it, just in case).
The STorM32 controller needs to be rebooted when you change Mavlink Uart Port. Changes to the other settings become effective immediately. However, depending on the situation, you may have to reboot the complete system (gimbal and flight controller and GCS) to reset internal states and auto-detection mechanisms in these components in order for all to work properly (so, if you change a parameter and something looks odd, restart/reset the whole system).
Comment: While the STorM32 gimbal will work perfectly with “off” for Mavlink Gimbal Stream, BetaPilot won't, i.e., you must choose “mountstatus” or higher. Typically you want to choose “device status” or “manager status”.
Settings in BetaPilot:
- MNT1_TYPE = 83
- MNT1_ZFLAGS = 0
- SERIALx_PROTOCOL = 2
- SERIALx_BAUD = 115
SERIALx can be any of the available serial ports SERIAL1, SERIAL2, and so on ('x' stands for 1, 2, ...). This enables the STorM32 MAVLink2 mount. The flight controller must be rebooted for the changes to become effective.
The default baudrate of the STorM32 serial ports is 115200 bps, in ArduPilot SERIALx_BAUD is hence been set to 115.
With these settings you should notice this:
- In MissonPlanner or any other GCS, a additional MAVLink component named GIMBAL will be present.
- In the STorM32 [GUI:Dashboard], the MAVLINK field will show PRESENT.
- In the STorM32[GUI:Dashboard], the STorM32-Link field will show PRESENT or a similar positive message.
This provides quick indicators for whether things are working or not. For further testing, please see Testing the Connection.
The above settings establish the basic configuration. Some features need additional parameters to be adjusted, which will be described in the following chapters.
Baudrate Settings
It is strongly recommended to use 230400 bps, especially if the STorM32-Link is being used.
The baudrate needs to be changed in both STorM32 and BetaPilot:
- Uart Baudrate = “230400”
- SERIALx_BAUD = 230
Here it was assumed that the UART port is used for MAVLink, i.e, Mavlink Uart Port = “uart”. If this is not your case, then set the baudrate for the serial port which you are using.
Further Settings in BetaPilot to Consider
Please disable (set to 0) all SRx streaming parameters for the serial port you are using for STorM32. This avoids that the STorM32 controller is bombarded with superfluous messages and helps it to achieve consistent behavior. Depending on the vehicle type and ArduPilot firmware version you may find that the streaming parameters are enabled or disabled by default. So, please check.
Depending on the details of the ArduPilot setup it can come to DMA contention issues (has nothing to do with BetaPilot, is low-level ArduPilot behavior), which especially can make STorM32-Link to not work properly. If you have hints that such an issue exists in your case, you can try this: Disable all unused serial ports (SERIALx_PROTOCOL = -1)(this is generally a good advice to do). You also may try enabling the TX_NoDMA flag in the SERIALx_OPTIONS parameter (and maybe also the RX_NoDMA flag). It also can help to simply use a different serial port on the flight controller (different SERIALx). Please do not hesitate to join a STorM32 discussion thread at rcgroups for further discussion. (the original thread discussing the issue is here)
BetaPilot also supports the MAVLink messages of the mLRS project, which can provide substantial benefits. Consult the mLRS discussion thread for further information.
BetaPilot introduces the additional parameter MNTx_ZFLAGS, which allows you to adjust the behavior of BetaPilot in various ways:
- 0: protocol is auto determined
- 1: protocol forced to PROTOCOL_ARDUPILOT_LIKE
- 2: protocol forced to PROTOCOL_STORM32_GIMBAL_MANAGER
- 8: only streaming (only sends out RC_CHANNLES, AUTOPILOT_STATE_FOR_GIMBAL for STorM32-Link)
- 64: do not use 3way photo-video switch mode for 'Camera Mode Toggle' aux function
- 128: do not log STorM32 MAVLink2 mount specifc messages
STorM32-Link
Requires this additional setting:
Settings in STorM32:
- STorM32Link Configuration = “v1”
With MNTx_TYPE = 83, the flight controller also sends out the STorM32-Link data to the STorM32 gimbal, but these data are used by the STorM32 controller only when STorM32Link Configuration = “v1” is also set.
Comment: This setting does not affect the information shown in the [GUI:Dashboard] STorM32-Link field! The information shown there, such as 'not available', PRESENT, AVAILABLE, OK, reflects the incoming data stream, not its usage.
For more details on the STorM32-Link, please read the article STorM32-Link.
Virtual Channel Configuration
Requires this additional setting:
Settings 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 it if the STorM32 controller would be directly connected to a receiver by traditional means (PWM, PPM, sbus, and so on).
This allows us to do many useful things, such as activating a script or triggering video on/off from the transmitter. It however also allows us to do nonsense, and it is in the user's responsibility to avoid that.
For instance, if ArduPilot 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 ArduPilot and the receiver. On the other hand, if ArduPilot 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.
Comment: BetaPilot ignores channel data which are sent to the flight controller via MAVLink RC_CHANNELS_OVERRIDE messages but only forwards the channel data which the flight controller obtains by "traditional" means such as CRSF, SBus, or PPM, or the mLRS specifc RADIO_RC_CHANNELS MAVLink message (if configured accordingly).
Passthrough Configuration
This feature allows you to connect the STorM32 GUI to the USB or any (MAVLink enabled) serial port of the flight controller, and to directly communicate with the STorM32 gimbal.
This is extremely convenient for configuring STorM32 gimbals when they are e.g. installed permanently in the 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.
This preliminary demo video demonstrates the pass-through feature:
Prearm Checks
Requires this additional setting:
Settings in STorM32:
- Prearm Check != “off”
The STorM32 controller supports a rich set of prearm checks. The status of the prearm checks is passed on to the flight controller, and lets it handle them exactly like it handles any of its other prearm checks. For instance, in a GCS it will display a message "PreArm: Mount: not healthy" in intervals of 30 seconds, as well as more information such as "MNT1: prearm checks FAIL: mot,volt" which provides more insight into which prearm check failed.
This provides a simple and quick check that the STorM32 gimbal is working as intended, and is obviously also highly useful to check before takeoff that the system is working normally, including the gimbal.
For more details on the prearm checks, please read the article Prearm Checks.
Auxiliary Functions
The following ArduPilot auxiliariy functions can be used:
- "Mount Lock": allows to switch between yaw pan (aka follow) and yaw hold (aka lock) mode. HIGH: yaw lock, else yaw pan.
- "Retract Mount1": allows to put the gimbal into retract mode (MAV_MOUNT_MODE_RETRACT, GIMBAL_DEVICE_FLAGS_RETRACT). HIGH: retract, MID: last mode, LOW: default mode.
- "Camera Trigger": triggers taking a photo. HIGH: take photo when in photo mode.
- "Camera Mode Toggle": allows to switch between photo and video mode, as well as starts/stops the video recording. HIGH: change to video mode and start recording, MID: stop video recording if in video mode, else nothing, LOW: change to photo mode and take picture.
- "Camera Record Video": starts/stops video recording when in video mode. HIGH: start recording, else stop recording.
The auxiliary functions can be invoked by connecting them in ArduPilot to RC channels. They also can be invoked by sending the MAV_CMD_DO_AUX_FUNCTION command to teh autopilot. The latter can be connveniently done via MissionPlanner's Aux Function tab.
Comment: The auxiliary functions "Camera Mode Toggle" and "Camera Record Video" require that the CAM_TRIGG_TYPE parameter is set to 3 (Mount).
Statustext Messages
With MNTx_TYPE = 83, the flight controller sends various MAVLink STATUSTEXT messages to a ground control station, providing additional information.
In addition, MAVLink STATUSTEXT messages can also be send via STorM32 scripts, the SENDMAVTEXT command specifically. This provides a very versatile mechanism to communicate to the user.
STorM32 MAVLink Gimbal Protocol
With BetaPilot installed, the flight controller supports the STorM32 MAVLink Gimbal Protocol.
For more info on the STorM32 MAVLink Gimbal Protocol see MAVLink Communication: Gimbal Protocol V2.
MAVLink Camera Microservice
BetaPilot implements the MAVLink protocol as specified in the original MAVLink standard. Therefore, with BetaPilot installed, also the MAVLink Camera Microservice can be fully used.
The STorM32 gimbal controller also implements a MAVLink Camera controller, which is described in much detail in the articles MAVLink Camera and NT Camera.
Logging
BetaPilot and STorM32 provide a rich set of options for logging various data, which can tremendously help in confirming proper operation or diagnosing issues.
The operation of the STorM32 controller can be logged using a NTLogger, please consult the article NT Data Logging.
On the flight controller side, BetaPilot adds some dedicated data fields to ArduPilot's DataFlash logging (for DataFlash logs see Downloading and Analyzing Data Logs in Mission Planner).
Comment: In case of issues it is highly useful and hence highly recommended to share both the NTLogger logs for the STorM32 controller (if available) and the DataFlash logs of BetaPilot, as well as the parameter settings for the STorM32 controller and BetaPilot.
Testing the Connection
The serial MAVLink connection can be tested in several ways. The following tests do not require that the vehicle is completely built and/or set up, and do not require that the vehicle is armed. For many of the tests it is also not even required that the gimbal is completely build or functioning.
MAVLINK field in STorM32 GUI
The [GUI:Dashboard] has a field named MAVLINK. It should display PRESENT.
Comment: MAVLINK is PRESENT means (only) that the STorM32 controller has a system ID and is receiving some MAVLink messages. It does not mean that the STorM32 controller makes any use of the received messages. The gimbal or camera component must be enabled for that.
STorM32-LINK field in STorM32 GUI
Both the [GUI:Dashboard] and the [GUI:Data Display] each have a field which is related to the STorM32-Link. They should display PRESENT, AVAILABLE or OK.
Comment: STorM32-Link is PRESENT, AVAILABLE, OK means (only) that the STorM32 controller is receiving the STorM32-Link data and what their quality is. It does not mean that the STorM32-Link data are used. If it is used or not is determined by the setting in STorM32Link Configuration.
Mavlink Inspector in STorM32 GUI
The [GUI:Mavlink Inspector Tool] displays the MAVLink messages which the STorM32 controller receives and can handle.
Comment: Only MAVLink messages are displayed which the STorM32 controller can handle. The fact that messages are displayed does not mean that the STorM32 controller does indeed handle these messages; this depends on the settings. All it means is that the STorM32 controller is receiving these messages.
Comment: This screen shot shows the messages when the gimbal operates as gimbal manager, it will look differently in other cases.
MissonPlanner or QGroundControl
With the Gimbal component enabled, a MAVLink component named GIMBAL or GIMBALx (x = 2...6) should be present. If the Camera component is enabled, a component named CAMERAx (x = 1...6) should be present.
In MissionPlanner for instance:
MissonPlanner Messages Box
MissionPlanner's Messages box should show several text messages related to the STorM32 gimbal. In particular, a message like "STorM32 v2.40 nt v1.30 F103RC" informing about the STorM32 firmware version should be visible.
Comment: The messages shown depend on which component (autopilot, gimbal or camera) is selected in MissionPlanner. This can be a bit confusing. The STorM32 specific messages are seen only when the gimbal or camera component is selected. When the autopilot component is selected, the messages from BetaPilot are seen.
Campoint in MissonPlanner Status Box
With the autopilot component selected in MissionPlanner, the campointa/b/c values in the Status box should show non-zero values and should move according to the movement of the gimbal.
Comment: If you select the gimbal component instead of the autopilot in MissionPlanner, then it will depend on your configuaration what you will see happening in MissionPlanner when the gimbal moves.
Mission Planner Payload Control Box
When the autopilot component is selected in MissionPlanner, the Payload Control box is available to control the pitch and yaw of the gimbal.
For this to work, the autopilot/mount needs to have been set into MAVLink targeting mode (MAV_MOUNT_MODE_MAVLINK_TARGETING). This can conveniently be achieved in MisssionPlanner through the Action box.
Comment: Be carefull with moving the sliders in the Payload Control box; small changes can lead to large gimbal movements.
Gimbal RC Targeting
When the autopilot/mount is in RC Targeting mode (which should be the default mode), the gimbal can be moved with the transmitter sticks.
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:
- MNTx_STAB_ROLL = 0
- MNTx_STAB_TILT = 1