@Override public void onNewMessage(FootstepDataListRosMessage message) { ArrayList<us.ihmc.humanoidRobotics.communication.packets.walking.FootstepDataMessage> footStepDataArrayList = new ArrayList<us.ihmc.humanoidRobotics.communication.packets.walking.FootstepDataMessage>(); List<FootstepDataRosMessage> footStepDataList = message.getFootstepDataList(); FootStepDataMessageConverter.convertFootStepDataList(footStepDataList, footStepDataArrayList); ExecutionMode executionMode = ExecutionMode.values[(int) message.getExecutionMode()]; controllerCommunicator.send(new us.ihmc.humanoidRobotics.communication.packets.walking.FootstepDataListMessage(footStepDataArrayList,message.getDefaultSwingTime(),message.getDefaultTransferTime(),executionMode)); } }
@Override public void onNewMessage(FootstepDataListRosMessage message) { ArrayList<us.ihmc.humanoidRobotics.communication.packets.walking.FootstepDataMessage> footStepDataArrayList = new ArrayList<us.ihmc.humanoidRobotics.communication.packets.walking.FootstepDataMessage>(); List<FootstepDataRosMessage> footStepDataList = message.getFootstepDataList(); FootStepDataMessageConverter.convertFootStepDataList(footStepDataList, footStepDataArrayList); ExecutionMode executionMode = ExecutionMode.values[(int) message.getExecutionMode()]; controllerCommunicator.send(new us.ihmc.humanoidRobotics.communication.packets.walking.FootstepDataListMessage(footStepDataArrayList,message.getSwingTime(),message.getTransferTime(),executionMode)); } }
private static Packet customConvertToIHMCMessage(FootstepDataListRosMessage message) throws Exception { FootstepDataListMessage footsteps = new FootstepDataListMessage(); footsteps.swingTime = message.getSwingTime(); footsteps.transferTime = message.getTransferTime(); footsteps.setUniqueId(message.getUniqueId()); footsteps.executionMode = ExecutionMode.values[message.getExecutionMode()]; ArrayList<FootstepDataMessage> stepData = new ArrayList<>(); for (FootstepDataRosMessage footstepDataRosMessage : message.getFootstepDataList()) { stepData.add((FootstepDataMessage) convertToIHMCMessage(footstepDataRosMessage)); } footsteps.footstepDataList = stepData; return footsteps; }
private static Packet customConvertToIHMCMessage(FootstepDataListRosMessage message) throws Exception { FootstepDataListMessage footsteps = new FootstepDataListMessage(); footsteps.defaultSwingTime = message.getDefaultSwingTime(); footsteps.defaultTransferTime = message.getDefaultTransferTime(); footsteps.setUniqueId(message.getUniqueId()); footsteps.executionMode = ExecutionMode.values[message.getExecutionMode()]; footsteps.finalTransferTime = message.getFinalTransferTime(); ArrayList<FootstepDataMessage> stepData = new ArrayList<>(); for (FootstepDataRosMessage footstepDataRosMessage : message.getFootstepDataList()) { stepData.add((FootstepDataMessage) convertToIHMCMessage(footstepDataRosMessage)); } footsteps.footstepDataList = stepData; return footsteps; }
for (FootstepDataRosMessage footstepDataRosMessage : message.getFootstepDataList())