congrats Icon
New! Announcing Tabnine Chat Beta
Learn More
Tabnine Logo
IHMCRealtimeROS2Publisher.publish
Code IndexAdd Tabnine to your IDE (free)

How to use
publish
method
in
us.ihmc.communication.IHMCRealtimeROS2Publisher

Best Java code snippets using us.ihmc.communication.IHMCRealtimeROS2Publisher.publish (Showing top 20 results out of 315)

origin: us.ihmc/ihmc-humanoid-robotics

@Override
public void sendPelvisPoseErrorPacket(PelvisPoseErrorPacket pelvisPoseErrorPacket)
{
 if (poseErrorPublisher != null)
   poseErrorPublisher.publish(pelvisPoseErrorPacket);
}
origin: us.ihmc/ihmc-humanoid-robotics

  @Override
  public void sendLocalizationResetRequest(LocalizationPacket localizationPacket)
  {
   if (localizationPublisher != null)
     localizationPublisher.publish(localizationPacket);
  }
}
origin: us.ihmc/ihmc-footstep-planning-visualizers

private void requestAbortPlanning()
{
 if (verbose)
   PrintTools.info("Sending out a sleep request.");
 toolboxStatePublisher.publish(MessageTools.createToolboxStateMessage(ToolboxState.SLEEP));
}
origin: us.ihmc/ihmc-avatar-interfaces

  private void sendMessageToUI(String message)
  {
   textToSpeechPublisher.publish(MessageTools.createTextToSpeechPacket(message));
  }
}
origin: us.ihmc/ihmc-avatar-interfaces

private void sendMessageToUI(String message)
{
 textToSpeechPublisher.publish(MessageTools.createTextToSpeechPacket(message));
}
origin: us.ihmc/ihmc-footstep-planning-visualizers

private void requestPlannerStatistics()
{
 plannerStatisticsRequestPublisher.publish(new PlanningStatisticsRequestMessage());
}
origin: us.ihmc/ihmc-avatar-interfaces

  @Override
  public void run()
  {
   HandJointAnglePacket copyForReading = packetCopier.getCopyForReading();
   if (copyForReading != null)
   {
     if (publisher != null)
     {
      publisher.publish(copyForReading);
     }
   }
  }
}, 0, WORKER_SLEEP_TIME_MILLIS, TimeUnit.MILLISECONDS);
origin: us.ihmc/ihmc-avatar-interfaces

private void sendMessageToUI(String message)
{
 textToSpeechPublisher.publish(MessageTools.createTextToSpeechPacket(message));
}
origin: us.ihmc/ihmc-avatar-interfaces

private void sendMessageToUI(String message)
{
 textToSpeechPublisher.publish(MessageTools.createTextToSpeechPacket(message));
}
origin: us.ihmc/ihmc-footstep-planning-visualizers

private void requestNewPlan()
{
 toolboxStatePublisher.publish(MessageTools.createToolboxStateMessage(ToolboxState.WAKE_UP));
 if (verbose)
   PrintTools.info("Told the toolbox to wake up.");
 
 FootstepPlannerParametersPacket plannerParametersPacket = new FootstepPlannerParametersPacket();
 FootstepPlannerParameters footstepPlannerParameters = plannerParametersReference.get();
 copyFootstepPlannerParametersToPacket(plannerParametersPacket, footstepPlannerParameters);
 plannerParametersPublisher.publish(plannerParametersPacket);
 VisibilityGraphsParametersPacket visibilityGraphsParametersPacket = new VisibilityGraphsParametersPacket();
 VisibilityGraphsParameters visibilityGraphsParameters = visibilityGraphParametersReference.get();
 copyVisibilityGraphsParametersToPacket(visibilityGraphsParametersPacket, visibilityGraphsParameters);
 visibilityGraphsParametersPublisher.publish(visibilityGraphsParametersPacket);
 
 if (verbose)
   PrintTools.info("Sent out some parameters");
 submitFootstepPlanningRequestPacket();
}
origin: us.ihmc/ihmc-robot-data-visualizer

lidarScanPublisher.publish(lidarScanMessage);
origin: us.ihmc/ihmc-footstep-planning-visualizers

private void checkAndPublishIfInvalidResult()
{
 if (resultReference.get().validForExecution())
   return;
 FootstepPlanningToolboxOutputStatus result = new FootstepPlanningToolboxOutputStatus();
 FootstepPlanningResult planningResult = resultReference.getAndSet(null);
 planarRegionsList.ifPresent(regions -> result.getPlanarRegionsList().set(PlanarRegionMessageConverter.convertToPlanarRegionsListMessage(regions)));
 result.setFootstepPlanningResult(planningResult.toByte());
 result.setPlanId(plannerRequestIdReference.get());
 outputStatusPublisher.publish(result);
 if (verbose)
   PrintTools.info("Finished planning, but result isn't valid, so publishing blank result on the network.");
}
origin: us.ihmc/ihmc-footstep-planning-visualizers

private void submitFootstepPlanningRequestPacket()
{
 FootstepPlanningRequestPacket packet = new FootstepPlanningRequestPacket();
 packet.getStanceFootPositionInWorld().set(plannerStartPositionReference.get());
 packet.getStanceFootOrientationInWorld().set(plannerStartOrientationReference.get());
 packet.getGoalPositionInWorld().set(plannerGoalPositionReference.get());
 packet.getGoalOrientationInWorld().set(plannerGoalOrientationReference.get());
 if (plannerInitialSupportSideReference.get() != null)
   packet.setInitialStanceRobotSide(plannerInitialSupportSideReference.get().toByte());
 if (plannerTimeoutReference.get() != null)
   packet.setTimeout(plannerTimeoutReference.get());
 if (plannerTypeReference.get() != null)
   packet.setRequestedFootstepPlannerType(plannerTypeReference.get().toByte());
 if (plannerRequestIdReference.get() != null)
   packet.setPlannerRequestId(plannerRequestIdReference.get());
 if (plannerHorizonLengthReference.get() != null)
   packet.setHorizonLength(plannerHorizonLengthReference.get());
 if (plannerPlanarRegionReference.get() != null)
   packet.getPlanarRegionsListMessage().set(PlanarRegionMessageConverter.convertToPlanarRegionsListMessage(plannerPlanarRegionReference.get()));
 footstepPlanningRequestPublisher.publish(packet);
}
origin: us.ihmc/ihmc-footstep-planning-visualizers

private void publishResultingPlan()
{
 double totalWaitTime = 0.0;
 double maxWaitTime = 10.0;
 long sleepDuration = 1;
 while (resultReference.get() == null)
 {
   if (totalWaitTime > maxWaitTime)
   {
    if (verbose)
      PrintTools.info("Timed out waiting for a plan when we received a valid result for execution.");
    return;
   }
   ThreadTools.sleep(sleepDuration);
   totalWaitTime += Conversions.millisecondsToSeconds(sleepDuration);
 }
 if (verbose)
   PrintTools.info("Finished planning, publishing the result on the network.");
 FootstepPlanningToolboxOutputStatus result = new FootstepPlanningToolboxOutputStatus();
 FootstepPlanningResult planningResult = resultReference.getAndSet(null);
 if (!planningResult.validForExecution())
   throw new RuntimeException("The result is completely invalid, which is a problem.");
 FootstepPlan footstepPlan = footstepPlanReference.getAndSet(null);
 planarRegionsList.ifPresent(regions -> result.getPlanarRegionsList().set(PlanarRegionMessageConverter.convertToPlanarRegionsListMessage(regions)));
 result.setFootstepPlanningResult(planningResult.toByte());
 result.getFootstepDataList().set(convertToFootstepDataListMessage(footstepPlan));
 result.setPlanId(plannerRequestIdReference.get());
 receivedPlanIdReference.set(plannerRequestIdReference.get());;
 outputStatusPublisher.publish(result);
}
origin: us.ihmc/valkyrie

@Override
public void doControl()
{
 for (RobotSide robotSide : RobotSide.values)
 {
   packet.setRobotSide(robotSide.toByte());
   packet.getJointAngles().reset();
   for (ValkyrieHandJointName jointEnum : ValkyrieHandJointName.values)
   {
    double q = handJoints.get(robotSide).get(jointEnum).getQ();
    packet.getJointAngles().add(q);
   }
   publisher.publish(packet);
 }
}
origin: us.ihmc/ihmc-whole-body-controller

@Override
public void run()
{
 try
 {
   if (runController.getBooleanValue())
   {
    if (firstTick.getBooleanValue())
    {
      robotController.initialize();
      if (outputProcessor != null)
      {
       outputProcessor.initialize();
      }
      firstTick.set(false);
    }
    controllerTimer.startMeasurement();
    robotController.doControl();
    controllerTimer.stopMeasurement();
   }
 }
 catch (Exception e)
 {
   crashNotificationPublisher.publish(MessageTools.createControllerCrashNotificationPacket(ControllerCrashLocation.CONTROLLER_RUN, e.getMessage()));
   throw new RuntimeException(e);
 }
}
origin: us.ihmc/ihmc-avatar-interfaces

controllerCrashPublisher.publish(MessageTools.createControllerCrashNotificationPacket(ControllerCrashLocation.ESTIMATOR_RUN, e.getMessage()));
origin: us.ihmc/ihmc-avatar-interfaces

controllerCrashPublisher.publish(MessageTools.createControllerCrashNotificationPacket(ControllerCrashLocation.ESTIMATOR_WRITE, e.getMessage()));
origin: us.ihmc/ihmc-whole-body-controller

@Override
public void write(long timestamp)
{
 try
 {
   if (runController.getBooleanValue())
   {
    if (outputProcessor != null)
    {
      outputProcessor.processAfterController(controllerTimestamp.getLongValue());
    }
    totalDelay.set(timestamp - lastEstimatorStartTime.getLongValue());
    threadDataSynchronizer.publishControllerData();
    if (robotVisualizer != null)
    {
      robotVisualizerUpdateTimer.startMeasurement();
      robotVisualizer.update(controllerTimestamp.getLongValue(), registry);
      robotVisualizerUpdateTimer.stopMeasurement();
    }
    rootFrame.getTransformToDesiredFrame(rootToWorldTransform, ReferenceFrame.getWorldFrame());
    yoGraphicsListRegistry.setControllerTransformToWorld(rootToWorldTransform);
   }
 }
 catch (Exception e)
 {
   crashNotificationPublisher.publish(MessageTools.createControllerCrashNotificationPacket(ControllerCrashLocation.CONTROLLER_WRITE, e.getMessage()));
   throw new RuntimeException(e);
 }
}
origin: us.ihmc/ihmc-avatar-interfaces-test

@ContinuousIntegrationAnnotations.ContinuousIntegrationTest(estimatedDuration = 0.0)
@Test(timeout = timeout)
public void testWalkingBetweenBollardsAStarPlanner()
{
 DRCStartingLocation startingLocation = () -> new OffsetAndYawRobotInitialSetup(-1.5, 0.0, 0.007, 0.0);
 FramePose3D goalPose = new FramePose3D();
 goalPose.setX(1.5);
 setupSimulation(bollardPlanarRegions, startingLocation);
 CollisionCheckerScript collisionChecker = getCollisionChecker(500);
 drcSimulationTestHelper.createSimulation("FootstepPlannerEndToEndTest");
 drcSimulationTestHelper.getSimulationConstructionSet().addScript(collisionChecker);
 FootstepPlannerParameters parameters = getRobotModel().getFootstepPlannerParameters();
 FootstepPlannerParametersPacket parametersPacket = new FootstepPlannerParametersPacket();
 RemoteUIMessageConverter.copyFootstepPlannerParametersToPacket(parametersPacket, parameters);
 parametersPacket.setCheckForBodyBoxCollisions(true);
 parametersPacket.setReturnBestEffortPlan(false);
 footstepPlannerParametersPublisher.publish(parametersPacket);
 runEndToEndTestAndKeepSCSUpIfRequested(FootstepPlannerType.A_STAR, bollardPlanarRegions, goalPose);
}
us.ihmc.communicationIHMCRealtimeROS2Publisherpublish

Popular methods of IHMCRealtimeROS2Publisher

    Popular in Java

    • Updating database using SQL prepared statement
    • runOnUiThread (Activity)
    • startActivity (Activity)
    • putExtra (Intent)
    • URLConnection (java.net)
      A connection to a URL for reading or writing. For HTTP connections, see HttpURLConnection for docume
    • NoSuchElementException (java.util)
      Thrown when trying to retrieve an element past the end of an Enumeration or Iterator.
    • Executors (java.util.concurrent)
      Factory and utility methods for Executor, ExecutorService, ScheduledExecutorService, ThreadFactory,
    • DataSource (javax.sql)
      An interface for the creation of Connection objects which represent a connection to a database. This
    • JFileChooser (javax.swing)
    • Join (org.hibernate.mapping)
    • Top Sublime Text plugins
    Tabnine Logo
    • Products

      Search for Java codeSearch for JavaScript code
    • IDE Plugins

      IntelliJ IDEAWebStormVisual StudioAndroid StudioEclipseVisual Studio CodePyCharmSublime TextPhpStormVimGoLandRubyMineEmacsJupyter NotebookJupyter LabRiderDataGripAppCode
    • Company

      About UsContact UsCareers
    • Resources

      FAQBlogTabnine AcademyTerms of usePrivacy policyJava Code IndexJavascript Code Index
    Get Tabnine for your IDE now