public static void write(controller_msgs.msg.dds.WholeBodyTrajectoryToolboxOutputStatus data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); cdr.write_type_2(data.getPlanningResult()); if(data.getTrajectoryTimes().size() <= 50) cdr.write_type_e(data.getTrajectoryTimes());else throw new RuntimeException("trajectory_times field exceeds the maximum length"); if(data.getRobotConfigurations().size() <= 50) cdr.write_type_e(data.getRobotConfigurations());else throw new RuntimeException("robot_configurations field exceeds the maximum length"); }
public static void write(shape_msgs.msg.dds.SolidPrimitive data, us.ihmc.idl.CDR cdr) { cdr.write_type_9(data.getType()); if(data.getDimensions().size() <= 3) cdr.write_type_e(data.getDimensions());else throw new RuntimeException("dimensions field exceeds the maximum length"); }
public static void write(controller_msgs.msg.dds.KinematicsPlanningToolboxOutputStatus data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); if(data.getKeyFrameTimes().size() <= 100) cdr.write_type_e(data.getKeyFrameTimes());else throw new RuntimeException("key_frame_times field exceeds the maximum length"); if(data.getRobotConfigurations().size() <= 100) cdr.write_type_e(data.getRobotConfigurations());else throw new RuntimeException("robot_configurations field exceeds the maximum length"); cdr.write_type_6(data.getSolutionQuality()); }
public static String validateDesiredAccelerationsMessage(DesiredAccelerationsMessage message) { if (message == null) return "is null."; if (message.getDesiredJointAccelerations() == null) { return "desired acceleration buffer null"; } if (message.getDesiredJointAccelerations().size() == 0) { return "desired acceleration buffer empty"; } return null; } }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.KinematicsPlanningToolboxCenterOfMassMessage 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 += (data.getWayPointTimes().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); for(int i0 = 0; i0 < data.getDesiredWayPointPositionsInWorld().size(); ++i0) { current_alignment += geometry_msgs.msg.dds.PointPubSubType.getCdrSerializedSize(data.getDesiredWayPointPositionsInWorld().get(i0), current_alignment);} current_alignment += controller_msgs.msg.dds.SelectionMatrix3DMessagePubSubType.getCdrSerializedSize(data.getSelectionMatrix(), current_alignment); current_alignment += controller_msgs.msg.dds.WeightMatrix3DMessagePubSubType.getCdrSerializedSize(data.getWeights(), current_alignment); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(trajectory_msgs.msg.dds.JointTrajectoryPoint data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getPositions().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getVelocities().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getAccelerations().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getEffort().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += builtin_interfaces.msg.dds.DurationPubSubType.getCdrSerializedSize(data.getTimeFromStart(), current_alignment); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.WholeBodyTrajectoryToolboxOutputStatus 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 += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getTrajectoryTimes().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); for(int i0 = 0; i0 < data.getRobotConfigurations().size(); ++i0) { current_alignment += controller_msgs.msg.dds.KinematicsToolboxOutputStatusPubSubType.getCdrSerializedSize(data.getRobotConfigurations().get(i0), current_alignment);} return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.KinematicsPlanningToolboxOutputStatus 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 += (data.getKeyFrameTimes().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); for(int i0 = 0; i0 < data.getRobotConfigurations().size(); ++i0) { current_alignment += controller_msgs.msg.dds.KinematicsToolboxOutputStatusPubSubType.getCdrSerializedSize(data.getRobotConfigurations().get(i0), current_alignment);} current_alignment += 8 + us.ihmc.idl.CDR.alignment(current_alignment, 8); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.RigidBodyExplorationConfigurationMessage 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 += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getConfigurationSpaceNamesToExplore().size() * 1) + us.ihmc.idl.CDR.alignment(current_alignment, 1); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getExplorationRangeUpperLimits().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getExplorationRangeLowerLimits().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(shape_msgs.msg.dds.SolidPrimitive data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += 1 + us.ihmc.idl.CDR.alignment(current_alignment, 1); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getDimensions().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); return current_alignment - initial_alignment; }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.HandJointAnglePacket data, int current_alignment) { int initial_alignment = current_alignment; current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += 1 + us.ihmc.idl.CDR.alignment(current_alignment, 1); current_alignment += 4 + us.ihmc.idl.CDR.alignment(current_alignment, 4); current_alignment += (data.getJointAngles().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += 1 + us.ihmc.idl.CDR.alignment(current_alignment, 1); current_alignment += 1 + us.ihmc.idl.CDR.alignment(current_alignment, 1); return current_alignment - initial_alignment; }
public static void write(std_msgs.msg.dds.Float64MultiArray 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 final static int getCdrSerializedSize(std_msgs.msg.dds.Float64MultiArray 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() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); return current_alignment - initial_alignment; }
public static void write(controller_msgs.msg.dds.DesiredAccelerationsMessage data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); if(data.getDesiredJointAccelerations().size() <= 100) cdr.write_type_e(data.getDesiredJointAccelerations());else throw new RuntimeException("desired_joint_accelerations field exceeds the maximum length"); controller_msgs.msg.dds.QueueableMessagePubSubType.write(data.getQueueingProperties(), cdr); }
public void set(Double other) { resetQuick(); for(int i = 0; i < other.size(); i++) { add(other.get(i)); } }
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(controller_msgs.msg.dds.HandJointAnglePacket data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); cdr.write_type_9(data.getRobotSide()); if(data.getJointAngles().size() <= 100) cdr.write_type_e(data.getJointAngles());else throw new RuntimeException("joint_angles field exceeds the maximum length"); cdr.write_type_7(data.getConnected()); cdr.write_type_7(data.getCalibrated()); }
public static void write(controller_msgs.msg.dds.KinematicsPlanningToolboxCenterOfMassMessage data, us.ihmc.idl.CDR cdr) { cdr.write_type_4(data.getSequenceId()); if(data.getWayPointTimes().size() <= 100) cdr.write_type_e(data.getWayPointTimes());else throw new RuntimeException("way_point_times field exceeds the maximum length"); if(data.getDesiredWayPointPositionsInWorld().size() <= 100) cdr.write_type_e(data.getDesiredWayPointPositionsInWorld());else throw new RuntimeException("desired_way_point_positions_in_world field exceeds the maximum length"); controller_msgs.msg.dds.SelectionMatrix3DMessagePubSubType.write(data.getSelectionMatrix(), cdr); controller_msgs.msg.dds.WeightMatrix3DMessagePubSubType.write(data.getWeights(), cdr); }
@Override public void setFromMessage(DesiredAccelerationsMessage message) { desiredJointAccelerations.reset(); for (int i = 0; i < message.getDesiredJointAccelerations().size(); i++) { desiredJointAccelerations.add(message.getDesiredJointAccelerations().get(i)); } setQueueableCommandVariables(message.getQueueingProperties()); }
public final static int getCdrSerializedSize(controller_msgs.msg.dds.DesiredAccelerationsMessage 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 += (data.getDesiredJointAccelerations().size() * 8) + us.ihmc.idl.CDR.alignment(current_alignment, 8); current_alignment += controller_msgs.msg.dds.QueueableMessagePubSubType.getCdrSerializedSize(data.getQueueingProperties(), current_alignment); return current_alignment - initial_alignment; }