void SetupMavConnect(MAVLinkMessage message, mavlink_heartbeat_t hb)
{
sysidcurrent = message.sysid;
compidcurrent = message.compid;
mavlinkversion = hb.mavlink_version;
MAV.aptype = (MAV_TYPE) hb.type;
MAV.apname = (MAV_AUTOPILOT) hb.autopilot;
setAPType(message.sysid, message.compid);
MAV.sysid = message.sysid;
MAV.compid = message.compid;
MAV.recvpacketcount = message.seq;
log.InfoFormat("ID sys {0} comp {1} ver{2} type {3} name {4}", MAV.sysid, MAV.compid, mavlinkversion,
MAV.aptype.ToString(), MAV.apname.ToString());
}