Switched to MavLink.NET library