Added omegaZ

Added rotation rate for whisker plot to MAVLink message