Inter-Manager Queue

Interface Requirements from AM/SM:

->Get()function to get the top message from the queue
- Can either cause the message to pop out or interface must provide a separate ->Pop()
->Push()function to push a message to the queue
Should use <T> to allow any data structure in the queue
For reference agreed structure between SM and AM is attached below:

typedef struct {
    int8_t roll;     // Roll percentage
    int8_t yaw;      // Yaw percentage
    int8_t pitch;    // Pitch percentage
    int8_t throttle; // Throttle percentage
} RCMotorControlMessage_t;