Esempio n. 1
0
 public MavLink4Net.Messages.IMessage Deserialize(System.IO.BinaryReader reader)
 {
     MavLink4Net.Messages.Common.ControlSystemStateMessage message = new MavLink4Net.Messages.Common.ControlSystemStateMessage();
     message.TimeUsec       = reader.ReadUInt64();
     message.XAcc           = reader.ReadSingle();
     message.YAcc           = reader.ReadSingle();
     message.ZAcc           = reader.ReadSingle();
     message.XVel           = reader.ReadSingle();
     message.YVel           = reader.ReadSingle();
     message.ZVel           = reader.ReadSingle();
     message.XPos           = reader.ReadSingle();
     message.YPos           = reader.ReadSingle();
     message.ZPos           = reader.ReadSingle();
     message.Airspeed       = reader.ReadSingle();
     message.VelVariance[0] = reader.ReadSingle();
     message.VelVariance[1] = reader.ReadSingle();
     message.VelVariance[2] = reader.ReadSingle();
     message.PosVariance[0] = reader.ReadSingle();
     message.PosVariance[1] = reader.ReadSingle();
     message.PosVariance[2] = reader.ReadSingle();
     message.Q[0]           = reader.ReadSingle();
     message.Q[1]           = reader.ReadSingle();
     message.Q[2]           = reader.ReadSingle();
     message.Q[3]           = reader.ReadSingle();
     message.RollRate       = reader.ReadSingle();
     message.PitchRate      = reader.ReadSingle();
     message.YawRate        = reader.ReadSingle();
     return(message);
 }
Esempio n. 2
0
 public void Serialize(System.IO.BinaryWriter writer, MavLink4Net.Messages.IMessage message)
 {
     MavLink4Net.Messages.Common.ControlSystemStateMessage tMessage = message as MavLink4Net.Messages.Common.ControlSystemStateMessage;
     writer.Write(tMessage.TimeUsec);
     writer.Write(tMessage.XAcc);
     writer.Write(tMessage.YAcc);
     writer.Write(tMessage.ZAcc);
     writer.Write(tMessage.XVel);
     writer.Write(tMessage.YVel);
     writer.Write(tMessage.ZVel);
     writer.Write(tMessage.XPos);
     writer.Write(tMessage.YPos);
     writer.Write(tMessage.ZPos);
     writer.Write(tMessage.Airspeed);
     writer.Write(tMessage.VelVariance[0]);
     writer.Write(tMessage.VelVariance[1]);
     writer.Write(tMessage.VelVariance[2]);
     writer.Write(tMessage.PosVariance[0]);
     writer.Write(tMessage.PosVariance[1]);
     writer.Write(tMessage.PosVariance[2]);
     writer.Write(tMessage.Q[0]);
     writer.Write(tMessage.Q[1]);
     writer.Write(tMessage.Q[2]);
     writer.Write(tMessage.Q[3]);
     writer.Write(tMessage.RollRate);
     writer.Write(tMessage.PitchRate);
     writer.Write(tMessage.YawRate);
 }