public void sendIntrinsicPacket(LocalVideoPacket videoObject, int sensorId, String frameId, Time time) { if (cameraInfoPublishers[sensorId] == null) { return; } cameraInfoPublishers[sensorId].publish(frameId, videoObject.getIntrinsicParameters(), time); } }
public void publish(String frameID, IntrinsicParameters params, Time t) CameraInfo message = getMessage(); Header header = message.getHeader(); message.setR(R); publish(message);
public RosSCSCameraPublisher(ObjectCommunicator localObjectCommunicator, RosMainNode rosMainNode, PPSTimestampOffsetProvider ppsTimestampOffsetProvider, DRCRobotCameraParameters[] cameraParameters) { nSensors = cameraParameters.length; this.rosMainNode = rosMainNode; this.ppsTimestampOffsetProvider = ppsTimestampOffsetProvider; this.cameraParameters = cameraParameters; cameraPublisher = new RosImagePublisher[nSensors]; cameraInfoPublishers = new RosCameraInfoPublisher[nSensors]; for (int sensorId = 0; sensorId < nSensors; sensorId++) { cameraPublisher[sensorId] = new RosImagePublisher(); String imageTopic = cameraParameters[sensorId].getRosTopic(); rosMainNode.attachPublisher(imageTopic, cameraPublisher[sensorId]); if (cameraParameters[sensorId].getRosCameraInfoTopicName() != null && cameraParameters[sensorId].getRosCameraInfoTopicName() != "") { String infoTopic = cameraParameters[sensorId].getRosCameraInfoTopicName(); cameraInfoPublishers[sensorId] = new RosCameraInfoPublisher(); rosMainNode.attachPublisher(infoTopic, cameraInfoPublishers[sensorId]); } } localObjectCommunicator.attachListener(LocalVideoPacket.class, this); }
public void publish(String frameID, IntrinsicParameters params, Time t) CameraInfo message = getMessage(); Header header = message.getHeader(); message.setR(R); publish(message);
public RosSCSCameraPublisher(ObjectCommunicator localObjectCommunicator, RosMainNode rosMainNode, PPSTimestampOffsetProvider ppsTimestampOffsetProvider, DRCRobotCameraParameters[] cameraParameters) { nSensors = cameraParameters.length; this.rosMainNode = rosMainNode; this.ppsTimestampOffsetProvider = ppsTimestampOffsetProvider; this.cameraParameters = cameraParameters; cameraPublisher = new RosImagePublisher[nSensors]; cameraInfoPublishers = new RosCameraInfoPublisher[nSensors]; for (int sensorId = 0; sensorId < nSensors; sensorId++) { cameraPublisher[sensorId] = new RosImagePublisher(); String imageTopic = cameraParameters[sensorId].getRosTopic(); rosMainNode.attachPublisher(imageTopic, cameraPublisher[sensorId]); if (cameraParameters[sensorId].getRosCameraInfoTopicName() != null && cameraParameters[sensorId].getRosCameraInfoTopicName() != "") { String infoTopic = cameraParameters[sensorId].getRosCameraInfoTopicName(); cameraInfoPublishers[sensorId] = new RosCameraInfoPublisher(); rosMainNode.attachPublisher(infoTopic, cameraInfoPublishers[sensorId]); } } localObjectCommunicator.attachListener(LocalVideoPacket.class, this); }
public void sendIntrinsicPacket(LocalVideoPacket videoObject, int sensorId, String frameId, Time time) { if (cameraInfoPublishers[sensorId] == null) { return; } cameraInfoPublishers[sensorId].publish(frameId, videoObject.getIntrinsicParameters(), time); } }
public RosSCSCameraPublisher(ObjectCommunicator localObjectCommunicator, RosMainNode rosMainNode, PPSTimestampOffsetProvider ppsTimestampOffsetProvider, DRCRobotCameraParameters[] cameraParameters) { nSensors = cameraParameters.length; this.rosMainNode = rosMainNode; this.ppsTimestampOffsetProvider = ppsTimestampOffsetProvider; this.cameraParameters = cameraParameters; cameraPublisher = new RosImagePublisher[nSensors]; cameraInfoPublishers = new RosCameraInfoPublisher[nSensors]; for (int sensorId = 0; sensorId < nSensors; sensorId++) { cameraPublisher[sensorId] = new RosImagePublisher(); String imageTopic = cameraParameters[sensorId].getRosTopic(); rosMainNode.attachPublisher(imageTopic, cameraPublisher[sensorId]); if (cameraParameters[sensorId].getRosCameraInfoTopicName() != null && cameraParameters[sensorId].getRosCameraInfoTopicName() != "") { String infoTopic = cameraParameters[sensorId].getRosCameraInfoTopicName(); cameraInfoPublishers[sensorId] = new RosCameraInfoPublisher(); rosMainNode.attachPublisher(infoTopic, cameraInfoPublishers[sensorId]); } } localObjectCommunicator.attachListener(LocalVideoPacket.class, this); }
public void sendIntrinsicPacket(LocalVideoPacket videoObject, int sensorId, String frameId, Time time) { if (cameraInfoPublishers[sensorId] == null) { return; } cameraInfoPublishers[sensorId].publish(frameId, HumanoidMessageTools.toIntrinsicParameters(videoObject.getIntrinsicParameters()), time); } }