MAV queue and enqueue

Implemented the queue struct and enqueue