public void setMountConfigure(MAV_MOUNT_MODE mountmode, bool stabroll, bool stabpitch, bool stabyaw)
{
mavlink_mount_configure_t req = new mavlink_mount_configure_t();
req.target_system = MAV.sysid;
req.target_component = MAV.compid;
req.mount_mode = (byte) mountmode;
req.stab_pitch = (stabpitch == true) ? (byte) 1 : (byte) 0;
req.stab_roll = (stabroll == true) ? (byte) 1 : (byte) 0;
req.stab_yaw = (stabyaw == true) ? (byte) 1 : (byte) 0;
generatePacket((byte) MAVLINK_MSG_ID.MOUNT_CONFIGURE, req);
System.Threading.Thread.Sleep(20);
generatePacket((byte) MAVLINK_MSG_ID.MOUNT_CONFIGURE, req);
}