Filling out the mavros class, not yet done