public void setMountControl(double pa, double pb, double pc, bool islatlng)
{
mavlink_mount_control_t req = new mavlink_mount_control_t();
req.target_system = MAV.sysid;
req.target_component = MAV.compid;
if (!islatlng)
{
req.input_a = (int) pa;
req.input_b = (int) pb;
req.input_c = (int) pc;
}
else
{
req.input_a = (int) (pa*10000000.0);
req.input_b = (int) (pb*10000000.0);
req.input_c = (int) (pc*100.0);
}
generatePacket((byte) MAVLINK_MSG_ID.MOUNT_CONTROL, req);
System.Threading.Thread.Sleep(20);
generatePacket((byte) MAVLINK_MSG_ID.MOUNT_CONTROL, req);
}