public static void write(geometry_msgs.msg.TransformStamped data, Halodi.CDR.CDRSerializer cdr)
        {
            std_msgs.msg.HeaderPubSubType.write(data.header, cdr);

            cdr.write_type_d(data.child_frame_id);

            geometry_msgs.msg.TransformPubSubType.write(data.transform, cdr);
        }
 public override void deserialize(MemoryStream stream, geometry_msgs.msg.TransformStamped data)
 {
     using (BinaryReader reader = new BinaryReader(stream))
     {
         Halodi.CDR.CDRDeserializer cdr = new Halodi.CDR.CDRDeserializer(reader);
         read(data, cdr);
     }
 }
 public override void serialize(geometry_msgs.msg.TransformStamped data, MemoryStream stream)
 {
     using (BinaryWriter writer = new BinaryWriter(stream))
     {
         Halodi.CDR.CDRSerializer cdr = new Halodi.CDR.CDRSerializer(writer);
         write(data, cdr);
     }
 }
        public static void read(geometry_msgs.msg.TransformStamped data, Halodi.CDR.CDRDeserializer cdr)
        {
            data.header = std_msgs.msg.HeaderPubSubType.Create();
            std_msgs.msg.HeaderPubSubType.read(data.header, cdr);

            data.child_frame_id = cdr.read_type_d();
            data.transform      = geometry_msgs.msg.TransformPubSubType.Create();
            geometry_msgs.msg.TransformPubSubType.read(data.transform, cdr);
        }
Esempio n. 5
0
        public static void read(tf2_msgs.msg.TFMessage data, Halodi.CDR.CDRDeserializer cdr)
        {
            int transforms_length = cdr.read_type_2();

            data.transforms = new System.Collections.Generic.List <geometry_msgs.msg.TransformStamped>(transforms_length);
            for (int i = 0; i < transforms_length; i++)
            {
                geometry_msgs.msg.TransformStamped new_transforms = geometry_msgs.msg.TransformStampedPubSubType.Create();
                geometry_msgs.msg.TransformStampedPubSubType.read(new_transforms, cdr);
                data.transforms.Add(new_transforms);
            }
        }
        public static int getCdrSerializedSize(geometry_msgs.msg.TransformStamped data, int current_alignment)
        {
            int initial_alignment = current_alignment;

            current_alignment += std_msgs.msg.HeaderPubSubType.getCdrSerializedSize(data.header, current_alignment);

            current_alignment += 4 + Halodi.CDR.CDRCommon.alignment(current_alignment, 4) + data.child_frame_id.Length + 1;

            current_alignment += geometry_msgs.msg.TransformPubSubType.getCdrSerializedSize(data.transform, current_alignment);


            return(current_alignment - initial_alignment);
        }
        public static void read(halodi_msgs.msg.ExtrinsicCalibration data, Halodi.CDR.CDRDeserializer cdr)
        {
            int sensors_length = cdr.read_type_2();

            data.sensors = new System.Collections.Generic.List <geometry_msgs.msg.TransformStamped>(sensors_length);
            for (int i = 0; i < sensors_length; i++)
            {
                geometry_msgs.msg.TransformStamped new_sensors = geometry_msgs.msg.TransformStampedPubSubType.Create();
                geometry_msgs.msg.TransformStampedPubSubType.read(new_sensors, cdr);
                data.sensors.Add(new_sensors);
            }



            int links_length = cdr.read_type_2();

            data.links = new System.Collections.Generic.List <geometry_msgs.msg.TransformStamped>(links_length);
            for (int i = 0; i < links_length; i++)
            {
                geometry_msgs.msg.TransformStamped new_links = geometry_msgs.msg.TransformStampedPubSubType.Create();
                geometry_msgs.msg.TransformStampedPubSubType.read(new_links, cdr);
                data.links.Add(new_links);
            }



            int joints_length = cdr.read_type_2();

            data.joints = new System.Collections.Generic.List <halodi_msgs.msg.JointCalibration>(joints_length);
            for (int i = 0; i < joints_length; i++)
            {
                halodi_msgs.msg.JointCalibration new_joints = halodi_msgs.msg.JointCalibrationPubSubType.Create();
                halodi_msgs.msg.JointCalibrationPubSubType.read(new_joints, cdr);
                data.joints.Add(new_joints);
            }
        }
Esempio n. 8
0
 public void Set(TFMessage other)
 {
     if (other.transforms == null)
     {
         transforms = null;
     }
     else
     {
         transforms = new System.Collections.Generic.List <geometry_msgs.msg.TransformStamped>(other.transforms.Count);
         for (int i1 = 0; i1 < other.transforms.Count; i1++)
         {
             if (other.transforms[i1] == null)
             {
                 transforms.Add(null);
             }
             else
             {
                 geometry_msgs.msg.TransformStamped newElement = geometry_msgs.msg.TransformStampedPubSubType.Create();
                 geometry_msgs.msg.TransformStampedPubSubType.Copy(other.transforms[i1], newElement);
                 transforms.Add(newElement);
             }
         }
     }
 }
        public void Set(ExtrinsicCalibration other)
        {
            if (other.sensors == null)
            {
                sensors = null;
            }
            else
            {
                sensors = new System.Collections.Generic.List <geometry_msgs.msg.TransformStamped>(other.sensors.Count);
                for (int i1 = 0; i1 < other.sensors.Count; i1++)
                {
                    if (other.sensors[i1] == null)
                    {
                        sensors.Add(null);
                    }
                    else
                    {
                        geometry_msgs.msg.TransformStamped newElement = geometry_msgs.msg.TransformStampedPubSubType.Create();
                        geometry_msgs.msg.TransformStampedPubSubType.Copy(other.sensors[i1], newElement);
                        sensors.Add(newElement);
                    }
                }
            }

            if (other.links == null)
            {
                links = null;
            }
            else
            {
                links = new System.Collections.Generic.List <geometry_msgs.msg.TransformStamped>(other.links.Count);
                for (int i2 = 0; i2 < other.links.Count; i2++)
                {
                    if (other.links[i2] == null)
                    {
                        links.Add(null);
                    }
                    else
                    {
                        geometry_msgs.msg.TransformStamped newElement = geometry_msgs.msg.TransformStampedPubSubType.Create();
                        geometry_msgs.msg.TransformStampedPubSubType.Copy(other.links[i2], newElement);
                        links.Add(newElement);
                    }
                }
            }

            if (other.joints == null)
            {
                joints = null;
            }
            else
            {
                joints = new System.Collections.Generic.List <halodi_msgs.msg.JointCalibration>(other.joints.Count);
                for (int i3 = 0; i3 < other.joints.Count; i3++)
                {
                    if (other.joints[i3] == null)
                    {
                        joints.Add(null);
                    }
                    else
                    {
                        halodi_msgs.msg.JointCalibration newElement = halodi_msgs.msg.JointCalibrationPubSubType.Create();
                        halodi_msgs.msg.JointCalibrationPubSubType.Copy(other.joints[i3], newElement);
                        joints.Add(newElement);
                    }
                }
            }
        }
 public static void Copy(geometry_msgs.msg.TransformStamped src, geometry_msgs.msg.TransformStamped target)
 {
     target.Set(src);
 }
 public static int getCdrSerializedSize(geometry_msgs.msg.TransformStamped data)
 {
     return(getCdrSerializedSize(data, 0));
 }