searchState = JointstatesSearchState.WRITE;
}
private static void writeToRead(int jointStatesDepth) throws InterruptedException {
logger.warning("jointstates sending message " + MessageType.READREADY);
CommandDelegator.sendMessage(new Message(jointStatesDepth, CommandDelegator.getSide(), Side.COMMANDER, MessageType.READREADY));
logger.warning("jointstates waiting for message " + MessageType.READ);
if (CommandDelegator.receiveMessage().getMsgType() != MessageType.READ) {
logger.severe("jointstates protocol error");
}
searchState = JointstatesSearchState.READ;