@Override public String toString() { StringBuilder builder = new StringBuilder(); builder.append("["); for(int i = 0; i < size(); i++) { if(i > 0) { builder.append(", "); } builder.append(get(i)); } builder.append("]"); return builder.toString(); }
public static void write(us.ihmc.robotDataLogger.GraphicObjectMessage data, us.ihmc.idl.CDR cdr) { cdr.write_type_2(data.getRegistrationID()); if(data.getName().length() <= 255) cdr.write_type_d(data.getName());else throw new RuntimeException("name field exceeds the maximum length"); if(data.getYoVariableIndex().size() <= 1024) cdr.write_type_e(data.getYoVariableIndex());else throw new RuntimeException("yoVariableIndex field exceeds the maximum length"); if(data.getConstants().size() <= 128) cdr.write_type_e(data.getConstants());else throw new RuntimeException("constants field exceeds the maximum length"); us.ihmc.robotDataLogger.AppearanceDefinitionMessagePubSubType.write(data.getAppearance(), cdr); if(data.getListName().length() <= 255) cdr.write_type_d(data.getListName());else throw new RuntimeException("listName field exceeds the maximum length"); }
public static void write(controller_msgs.msg.dds.SnapFootstepPacket data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); if(data.getFootstepData().size() <= 100) cdr.write_type_e(data.getFootstepData());else throw new RuntimeException("footstep_data field exceeds the maximum length"); if(data.getFootstepOrder().size() <= 100) cdr.write_type_e(data.getFootstepOrder());else throw new RuntimeException("footstep_order field exceeds the maximum length"); if(data.getFlag().size() <= 100) cdr.write_type_e(data.getFlag());else throw new RuntimeException("flag field exceeds the maximum length"); }
public static void write(controller_msgs.msg.dds.VisibilityMapMessage data, us.ihmc.idl.CDR cdr) { cdr.write_type_2(data.getMapId()); if(data.getSourcePoints().size() <= 100) cdr.write_type_e(data.getSourcePoints());else throw new RuntimeException("source_points field exceeds the maximum length"); if(data.getSourceRegionIds().size() <= 100) cdr.write_type_e(data.getSourceRegionIds());else throw new RuntimeException("source_region_ids field exceeds the maximum length"); if(data.getTargetPoints().size() <= 100) cdr.write_type_e(data.getTargetPoints());else throw new RuntimeException("target_points field exceeds the maximum length"); if(data.getTargetRegionIds().size() <= 100) cdr.write_type_e(data.getTargetRegionIds());else throw new RuntimeException("target_region_ids field exceeds the maximum length"); }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.PlanarRegionMessage data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += geometry_msgs.msg.dds.PointPubSubType.getCdrSerializedSize(data.getRegionOrigin(), current_alignment); current_alignment += geometry_msgs.msg.dds.Vector3PubSubType.getCdrSerializedSize(data.getRegionNormal(), current_alignment); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); for(int i0 = 0; i0 < data.getVertexBuffer().size(); ++i0) { current_alignment += geometry_msgs.msg.dds.PointPubSubType.getCdrSerializedSize(data.getVertexBuffer().get(i0), current_alignment);} current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getConvexPolygonsSize().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); return current_alignment - initial_alignment; }
public static void write(controller_msgs.msg.dds.PlanarRegionMessage data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); cdr.write_type_2(data.getRegionId()); geometry_msgs.msg.dds.PointPubSubType.write(data.getRegionOrigin(), cdr); geometry_msgs.msg.dds.Vector3PubSubType.write(data.getRegionNormal(), cdr); if(data.getVertexBuffer().size() <= 1000) cdr.write_type_e(data.getVertexBuffer());else throw new RuntimeException("vertex_buffer field exceeds the maximum length"); cdr.write_type_2(data.getConcaveHullSize()); cdr.write_type_2(data.getNumberOfConvexPolygons()); if(data.getConvexPolygonsSize().size() <= 20) cdr.write_type_e(data.getConvexPolygonsSize());else throw new RuntimeException("convex_polygons_size field exceeds the maximum length"); }
private RemoteYoGraphic getRemoteGraphic(GraphicObjectMessage graphicObjectMessage) { int registrationID = graphicObjectMessage.getRegistrationID(); String name = graphicObjectMessage.getNameAsString(); YoVariable<?>[] vars = new YoVariable[graphicObjectMessage.getYoVariableIndex().size()]; for (int v = 0; v < vars.length; v++) vars[v] = variables.get(graphicObjectMessage.getYoVariableIndex().get(v)); double[] consts = graphicObjectMessage.getConstants().toArray(); AppearanceDefinition appearance = new YoAppearanceRGBColor(new MutableColor((float) graphicObjectMessage.getAppearance().getR(), (float) graphicObjectMessage.getAppearance().getG(), (float) graphicObjectMessage.getAppearance().getB()), graphicObjectMessage.getAppearance().getTransparency()); return yoGraphicFromMessage(registrationID, name, vars, consts, appearance); } }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.SnapFootstepPacket data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); for(int i0 = 0; i0 < data.getFootstepData().size(); ++i0) { current_alignment += controller_msgs.msg.dds.FootstepDataMessagePubSubType.getCdrSerializedSize(data.getFootstepData().get(i0), current_alignment);} current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getFootstepOrder().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getFlag().size() * 1) + us.ihmc.idl.CDR.alignment(current_alignment, 1); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(us.ihmc.robotDataLogger.GraphicObjectMessage data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4) + data.getName().length() + 1; current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getYoVariableIndex().size() * 2) + us.ihmc.idl.CDR.alignment(current_alignment, 2); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getConstants().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += us.ihmc.robotDataLogger.AppearanceDefinitionMessagePubSubType.getCdrSerializedSize(data.getAppearance(), current_alignment); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4) + data.getListName().length() + 1; return current_alignment - initial_alignment; }
public static void write(std_msgs.msg.dds.UInt16MultiArray data, us.ihmc.idl.CDR cdr) { std_msgs.msg.dds.MultiArrayLayoutPubSubType.write(data.getLayout(), cdr); if(data.getData().size() <= 100) cdr.write_type_e(data.getData());else throw new RuntimeException("data field exceeds the maximum length"); }
public static void write(sensor_msgs.msg.dds.Joy data, us.ihmc.idl.CDR cdr) { std_msgs.msg.dds.HeaderPubSubType.write(data.getHeader(), cdr); if(data.getAxes().size() <= 100) cdr.write_type_e(data.getAxes());else throw new RuntimeException("axes field exceeds the maximum length"); if(data.getButtons().size() <= 100) cdr.write_type_e(data.getButtons());else throw new RuntimeException("buttons field exceeds the maximum length"); }
public static void write(std_msgs.msg.dds.Int32MultiArray data, us.ihmc.idl.CDR cdr) { std_msgs.msg.dds.MultiArrayLayoutPubSubType.write(data.getLayout(), cdr); if(data.getData().size() <= 100) cdr.write_type_e(data.getData());else throw new RuntimeException("data field exceeds the maximum length"); }
public static void write(controller_msgs.msg.dds.StereoVisionPointCloudMessage data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); cdr.write_type_11(data.getRobotTimestamp()); if(data.getPointCloud().size() <= 600000) cdr.write_type_e(data.getPointCloud());else throw new RuntimeException("point_cloud field exceeds the maximum length"); if(data.getColors().size() <= 200000) cdr.write_type_e(data.getColors());else throw new RuntimeException("colors field exceeds the maximum length"); }
public final static int getCdrSerializedSize(sensor_msgs.msg.dds.Joy data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += std_msgs.msg.dds.HeaderPubSubType.getCdrSerializedSize(data.getHeader(), current_alignment); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getAxes().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getButtons().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(std_msgs.msg.dds.Int32MultiArray data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += std_msgs.msg.dds.MultiArrayLayoutPubSubType.getCdrSerializedSize(data.getLayout(), current_alignment); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getData().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); return current_alignment - initial_alignment; }
public static void write(controller_msgs.msg.dds.KinematicsToolboxConfigurationMessage data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); geometry_msgs.msg.dds.PointPubSubType.write(data.getPrivilegedRootJointPosition(), cdr); geometry_msgs.msg.dds.QuaternionPubSubType.write(data.getPrivilegedRootJointOrientation(), cdr); if(data.getPrivilegedJointHashCodes().size() <= 100) cdr.write_type_e(data.getPrivilegedJointHashCodes());else throw new RuntimeException("privileged_joint_hash_codes field exceeds the maximum length"); if(data.getPrivilegedJointAngles().size() <= 100) cdr.write_type_e(data.getPrivilegedJointAngles());else throw new RuntimeException("privileged_joint_angles field exceeds the maximum length"); }
public void set(Integer other) { resetQuick(); for(int i = 0; i < other.size(); i++) { add(other.get(i)); } }
public final static int getCdrSerializedSize(std_msgs.msg.dds.UInt16MultiArray data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += std_msgs.msg.dds.MultiArrayLayoutPubSubType.getCdrSerializedSize(data.getLayout(), current_alignment); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getData().size() * 2) + us.ihmc.idl.CDR.alignment(current_alignment, 2); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.KinematicsToolboxConfigurationMessage data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += geometry_msgs.msg.dds.PointPubSubType.getCdrSerializedSize(data.getPrivilegedRootJointPosition(), current_alignment); current_alignment += geometry_msgs.msg.dds.QuaternionPubSubType.getCdrSerializedSize(data.getPrivilegedRootJointOrientation(), current_alignment); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getPrivilegedJointHashCodes().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getPrivilegedJointAngles().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.StereoVisionPointCloudMessage data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 8 + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getPointCloud().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getColors().size() * 4) + us.ihmc.idl.CDR.alignment(current_alignment, 4); return current_alignment - initial_alignment; }