UAVCAN

From STorM32-BGC Wiki
Jump to navigation Jump to search

The information on this page refers to firmware v2.40 and higher.

The STorM32 gimbal controller supports UAVCAN. This allows communicating with the STorM32 controller through a CAN bus, very similar to the communication through the serial interfaces or Wifi.

Configuration

The STorM32 parameters, which are related to UAVCAN, are split into the 'normal' and the 'UAVCAN' parameter sections. The parameters in the normal section are accessible like all the other parameters, e.g. via the GUI. The parameters in the UAVCAN section are however accessible only by using UAVCAN's Node configuration mechanism. The two parameter sections are exclusive, that is, a parameter is either in the one or the other section, but not in both. The single exception is the Uavcan Node ID parameter, which can be configured by either mechanism.

GUI Parameters

In the GUI, the parameters in the normal section are located in the [GUI:Interfaces Tool] window, which is accessible via the [GUI:Tools] menu.

Uavcan Configuration:
Set to “normal” to activate the UAVCAN communication. The STorM32 board needs to be reset for a change to become effective.

Uavcan Node ID:
Sets the node ID of the STorM32 controller (default = 71). Dynamic node allocation is not supported. The range of allowed IDs is restricted to 11 - 124. The STorM32 board needs to be reset for a change to become effective.

UAVCAN Parameters

The parameters in the UAVCAN section can be accessed e.g. using the UAVCAN GUI Tool, and a SLCAN adapter. A UC4H SLCAN adapter is probably the cheapest option, for an expensive option see the Zubax Babel.

NodeId:
Sets the node ID of the STorM32 controller (default = 71). Dynamic node allocation is not supported. The range of allowed IDs is restricted to 11 - 124. The STorM32 board needs to be reset for a change to become effective.

NodeStatus Rate:
Sets the rate at which the uavcan.protocol.NodeStatus message is emitted (default = 1000). A value of 1000 means that a message is broadcasted every 1000 ms.

GimbalStatus Rate:
Sets the rate at which the olliw.storm32.Status message is emitted (default = 500). A value of 500 means that a message is broadcasted every 500 ms. A value of 0 deactivates the emission of the message.

Debug:
A value of 1 enables the emission of uavcan.protocol.debug.LogMessage messages. A value of 0 deactivates the emission of the message.

UAVCAN Messages

The STorM32 controller supports the UAVCAN standard data types which are needed for basic operation, as well as the tunnel.Broadcast and debug.LogMessage data types.

NodeStatus (BC, ID 341)

See uavcan.protocol.NodeStatus.

GetNodeInfo (SR, ID 1)

See uavcan.protocol.GetNodeInfo.

RestartNode (SR, ID 5)

See uavcan.protocol.RestartNode.

param.ExecuteOpCode (SR, ID 10)

See uavcan.protocol.param.ExecuteOpcode.

param.GetSet (SR, ID 11)

See uavcan.protocol.param.GetSet.

tunnel.Broadcast (BC, ID 2010)

See uavcan.tunnel.Broadcast.

This message appears to not yet have been finally released to the official standard. It is most important though, since it provides the backbone for the communication with the STorM32 controller via UAVCAN. The STorM32 essentially implements a UAVCAN-UART bridge.

debug.LogMessage (BC, ID 16383)

See uavcan.protocol.debug.LogMessage.

STorM32 Data Types

The STorM32 supports also some STorM32 specific data types, which are located in the name space olliw.storm32.

olliw.storm32.Status (BC, ID 8300)

uint8 gimbal_id
uint8 mode
uint32 status
uint8 orientation_type
float32[4] orientation
float32[<=3] angular_velocity

Reports the camera orientation. Default is angles in degrees, and yaw angle relative to the gimbal frame or the vehicle.

olliw.storm32.Control (BC, ID 8301)

uint8 gimbal_id
uint8 mode
uint8 control_mode
float32[4] orientation
float32[<=3] angular_velocity

Moves the camera to the given orientation.

olliw.storm32.Command (BC, ID 8302)

uint8 gimbal_id         #0 means broadcast, any gimbal should listen
uint8[<=128] payload

The payload can correspond to any of the simple serial or RC commands, with the crc word stripped off (the crc is not needed since the message is already protected by UAVCAN]. Only commands of lengths less or equal 128 bytes can be handled (this excludes e.g. the 'p' command). The response of the STorM32 controller to the received command is packed into and send out as a olliw.storm32.CommandAck data type.

olliw.storm32.CommandAck (BC, ID 8303)

uint8 gimbal_id        #it cannot be zero, it must by a unique id of the gimbal
uint8[<=128] payload

The payload holds the response to any of the simple serial or RC commands, with the crc word stripped off. Only responses of lengths less or equal 128 bytes can be handled (this excludes e.g. the 'g' command).

Comments on STorM32 specific UAVCAN Data Types

Status, Control

I was considering supporting the camera_gimbal standard data types. However, they use only float16 for the quaternion and more seriously expect frames which gimbals generally cannot support, except in special situations. They are thus totally useless in practical terms, and there are no signs that useful standard data types would ever come to live. Hence the STorM32 specific data types.

Command, CommandAck

This set of messages provides access to all features of the STorM32 controller which are accessible via serial commands, and thus establish a powerful message set. They function very similar to the MAV_CMD_TARGET_SPECIFIC Mavlink command, so please read Comments on STorM32 specific Mavlink Messages. The same task can be accomplished with using the tunnel.Broadcast data type, but the STorM32 specific Command data types are somewhat denser and allow a somewhat faster handling, and thus are retained.

Example

The camera can be recentered by sending the RC command CMD_SETPITCHROLLYAW, with the pitch, roll, and yaw input values set to zero. This can be achieved by sending the byte stream

0xFA 0x06 0x12 0x00 0x00 0x00 0x00 0x00 0x00 crc-low-byte crc-high-byte

to any of the serial ports (USB, Uart, ...), or by sending a olliw.storm32.Command message to the CAN port, with the payload set to

0xFA 0x06 0x12 0x00 0x00 0x00 0x00 0x00 0x00

In the latter case, the STorM32 controller will respond with emitting a olliw.storm32.CommandAck message on the CAN port, with the payload set to

0xFB 0x01 0x96 0x00