📝 1. Overview
Initially, the focus is on basic functionality: sending drone state data to the ground station at regular intervals and establishing two-way communication between TM and the ground station (Mission Planner).
🎯 2. Goals
Achieve transmission of GLOBAL_POSITION_INT & ATTITUDE MAVLink messages from the drone to the ground control station (Mission Planner) via RFD 900 radio. Any missing sensor data will be filled with sample data at this time.
🛠️ 3. Class Definitions
📡 GroundStationCommunication
Owner: Roni Kant
Description
Handles communication between the ground station and drone using RFD 900 or equivalent modules, utilizing circular buffers for MAVLink message management.
Properties
DMAReceiveBuffer
: CircularBuffer - Stores incoming data.lowPriorityTransmitBuffer
: CircularBuffer - For low-priority data dispatch.highPriorityTransmitBuffer
: CircularBuffer - For high-priority routine data dispatch.
Methods
transmit(CircularBuffer &transmissionBuffer)
: Sends data to the ground station.receiveFromGroundStationISR()
: ISR for incoming data, discards ifDMAReceiveBuffer
is full.
Additional Notes
Flexible design compatible with various communication protocols and setups.
⏲️ TelemetryTask
Owner:
Description
This is essentially a wrapper for a FreeRTOS task that allows us to use a lambda function with access to the TM instance as a FreeRTOS task.
Constructor Signature
TelemetryTask(const char* taskName, int stackSize, UBaseType_t uxPriority, TelemetryManager& tm, Callback cbLambda)
Parameters
taskName
: The RTOS task namestackSize
: Task stack size.uxPriority
: Task priority.tm
: Reference to telemetry manager instance.cbLambda
: The callback function.
Note
Callback
is a type alias for std::function<void(TelemetryManager&)>
Implementation Details
🔄 MavlinkTranslator
Owner: Yarema Dzulynsky
Description
Translates MAVLink messages between byte streams and the drone/ground station.
Methods
bytesToMavlinkMsg(CircularBuffer &rxFromGroundByteQueue)
: Decodes incoming bytes to MAVLink messages.rxFromGroundByteQueue
: Buffer for incoming ground station bytes.
addMavlinkMsgToByteQueue(mavlink_message_t &msg, CircularBuffer &txToGroundByteQueue)
: Encodes MAVLink messages for transmission.msg
: The MAVLink message.txToGroundByteQueue
: Buffer for outgoing bytes to the ground station.
Additional Notes
Crucial for continuous and intermittent data handling via encoding and decoding.
🔗 CircularBuffer
Owner: Rahul Ramkumar
Description
Manages byte streams as MAVLink messages within TM components, using a circular queue/buffer for effective data buffering.
Properties
MAVLinkByte
:unsigned char
- Data type for queue storage, subject to change based on MAVLink byte requirements.
Methods
remainingMemory()
: Indicates available queue bytes.Returns:
int
- Available memory.
dequeue()
: Retrieves the next byte from the queue.Returns:
MAVLinkByte
- The dequeued byte.
enqueue(MAVLinkByte byte)
: Adds a byte to the queue.Parameters:
byte
:MAVLinkByte
- Byte to add.
lastFullMessageEndIndex()
: Indicates the position of the end of the last complete Mavlink message.Returns:
int
- The index of the end bit of the last complete Mavlink message.
currentIndex()
: Indicates the current position in the buffer.Returns:
int
- The current index in the buffer.
Additional Notes
A fundamental class for data integrity and memory efficiency in processing or waiting for transmission. Note, that we always check if the circular buffer has space before we add anything to it. This means that if one part of the program (MT.bytesToMavlinkMsg(GSC.DMAReceiveBuffer)) is accessing the buffer while an interrupt (GroundStationComms ISR) occurs, data integrity will remain if we ensure no overiting of data. The benefits of this approach are that we do not need to use mutex locks reducing the complexity. The drawback of this approach is that if we receive data, but the buffer is full, we need to discard the data.
🚀 Main Class Definition: System Initialization and Task Management
Owner:
Flow Chart
<INSERT FLOW CHART HERE>
Instances
GroundStationComms GSC: Oversees ground station comms.
MavlinkTranslator MT: MAVLink message and byte stream translator.
🌐 Function: init
Description
Sets up timer interrupts and FreeRTOS tasks for MAVLink communication and translation.
Components
Timer Interrupts: Configured for 500ms and 1000ms operation intervals.
FreeRTOS Tasks:
translateToMavlinkThread
: ProcessesGSC.DMAReceiveBuffer
bytes into MAVLink messages.mavlinkToBytesThread
: Loads MAVLink bytes intoGSC.lowPriorityTransmitBuffer
.
Scheduler: Engages the FreeRTOS scheduler for task oversight.
🔄 Tasks and ISRs
translateToMavlinkThread & mavlinkToBytesThread: Converts between MAVLink messages and byte streams for drone-ground station communication.
TimerISR500ms & TimerISR1000ms: Ensures regular data dispatch from both
GSC.lowPriorityTransmitBuffer
andGSC.highPriorityTransmitBuffer
.
⚙️ 5. Integration Points
Details subsystem interactions within the project and with external entities, focusing on integration mechanisms and their objectives.
PREVIOUS PAGE IGNORE:
TM Will:
Drone to Ground Station Communication via RFD 900 Radio
RX
Receive raw MAVLink bytes from the ground station.
TX
Transmit raw MAVLink bytes from the ground station.
Encode & Decode Raw MAVLink Data
Encode
Into Mavlink bytes to send to Mission Planner transmitted via RFD 900
Decode
Decode raw Mavlink bytes received from Mission Planner, received via RFD 900.
Ingest Drone State Data (Lat, Lng, Velocity, Pitch, etc) via C++ references
Should these references be passed at TM instantiation?
Is there a finite list of drone state data TM will be ingesting?
Sample rate?
TM will communicate with other managers via [UNDEFINED COMMUNICATION MEDIUM]: Maybe for TM, this should go in M3?
ROS LCM?
Byte Streams?
MQTT Style?
TM will have an input/output testing strategy
?
0 Comments