Exemplo n.º 1
0
        public void Set(PoseArray other)
        {
            std_msgs.msg.HeaderPubSubType.Copy(other.header, header);


            if (other.poses == null)
            {
                poses = null;
            }
            else
            {
                poses = new System.Collections.Generic.List <geometry_msgs.msg.Pose>(other.poses.Count);
                for (int i1 = 0; i1 < other.poses.Count; i1++)
                {
                    if (other.poses[i1] == null)
                    {
                        poses.Add(null);
                    }
                    else
                    {
                        geometry_msgs.msg.Pose newElement = geometry_msgs.msg.PosePubSubType.Create();
                        geometry_msgs.msg.PosePubSubType.Copy(other.poses[i1], newElement);
                        poses.Add(newElement);
                    }
                }
            }
        }
Exemplo n.º 2
0
        public static void read(geometry_msgs.msg.Pose data, Halodi.CDR.CDRDeserializer cdr)
        {
            data.position = geometry_msgs.msg.PointPubSubType.Create();
            geometry_msgs.msg.PointPubSubType.read(data.position, cdr);

            data.orientation = geometry_msgs.msg.QuaternionPubSubType.Create();
            geometry_msgs.msg.QuaternionPubSubType.read(data.orientation, cdr);
        }
Exemplo n.º 3
0
 public override void deserialize(MemoryStream stream, geometry_msgs.msg.Pose data)
 {
     using (BinaryReader reader = new BinaryReader(stream))
     {
         Halodi.CDR.CDRDeserializer cdr = new Halodi.CDR.CDRDeserializer(reader);
         read(data, cdr);
     }
 }
Exemplo n.º 4
0
 public override void serialize(geometry_msgs.msg.Pose data, MemoryStream stream)
 {
     using (BinaryWriter writer = new BinaryWriter(stream))
     {
         Halodi.CDR.CDRSerializer cdr = new Halodi.CDR.CDRSerializer(writer);
         write(data, cdr);
     }
 }
Exemplo n.º 5
0
        public static int getCdrSerializedSize(geometry_msgs.msg.Pose data, int current_alignment)
        {
            int initial_alignment = current_alignment;

            current_alignment += geometry_msgs.msg.PointPubSubType.getCdrSerializedSize(data.position, current_alignment);

            current_alignment += geometry_msgs.msg.QuaternionPubSubType.getCdrSerializedSize(data.orientation, current_alignment);


            return(current_alignment - initial_alignment);
        }
Exemplo n.º 6
0
        public static void read(geometry_msgs.msg.PoseArray data, Halodi.CDR.CDRDeserializer cdr)
        {
            data.header = std_msgs.msg.HeaderPubSubType.Create();
            std_msgs.msg.HeaderPubSubType.read(data.header, cdr);


            int poses_length = cdr.read_type_2();

            data.poses = new System.Collections.Generic.List <geometry_msgs.msg.Pose>(poses_length);
            for (int i = 0; i < poses_length; i++)
            {
                geometry_msgs.msg.Pose new_poses = geometry_msgs.msg.PosePubSubType.Create();
                geometry_msgs.msg.PosePubSubType.read(new_poses, cdr);
                data.poses.Add(new_poses);
            }
        }
Exemplo n.º 7
0
 public static void LocalUnity2Ros(this geometry_msgs.msg.Pose rosPose, Transform unityTransform)
 {
     rosPose.position.Unity2Ros(unityTransform.localPosition);
     rosPose.orientation.Unity2Ros(unityTransform.localRotation);
 }
Exemplo n.º 8
0
 public static void Copy(geometry_msgs.msg.Pose src, geometry_msgs.msg.Pose target)
 {
     target.Set(src);
 }
Exemplo n.º 9
0
        public static void write(geometry_msgs.msg.Pose data, Halodi.CDR.CDRSerializer cdr)
        {
            geometry_msgs.msg.PointPubSubType.write(data.position, cdr);

            geometry_msgs.msg.QuaternionPubSubType.write(data.orientation, cdr);
        }
Exemplo n.º 10
0
 public static int getCdrSerializedSize(geometry_msgs.msg.Pose data)
 {
     return(getCdrSerializedSize(data, 0));
 }
Exemplo n.º 11
0
 public static void Unity2Ros(this geometry_msgs.msg.Pose rosPose, Transform unityTransform, Transform referenceFrame)
 {
     rosPose.Position.Unity2Ros(unityTransform.position, referenceFrame);
     rosPose.Orientation.Unity2Ros(unityTransform.rotation, referenceFrame);
 }
Exemplo n.º 12
0
 public static void Unity2Ros(this geometry_msgs.msg.Pose rosPose, Transform unityTransform)
 {
     rosPose.Position.Unity2Ros(unityTransform.position);
     rosPose.Orientation.Unity2Ros(unityTransform.rotation);
 }