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

How to use
DiagnosticControllerToolbox
in
us.ihmc.wholeBodyController.diagnostics

Best Java code snippets using us.ihmc.wholeBodyController.diagnostics.DiagnosticControllerToolbox (Showing top 20 results out of 315)

origin: us.ihmc/ihmc-avatar-interfaces

public AutomatedDiagnosticConfiguration(DiagnosticControllerToolbox toolbox, AutomatedDiagnosticAnalysisController diagnosticController)
{
 this.toolbox = toolbox;
 this.diagnosticController = diagnosticController;
 enableLogging = toolbox.getDiagnosticParameters().enableLogging();
}
origin: us.ihmc/IHMCWholeBodyController

private static IMUDefinition findIMUDefinition(String imuName, DiagnosticControllerToolbox toolbox)
{
 IMUDefinition imuDefinition = null;
 IMUDefinition[] imuDefinitions = toolbox.getFullRobotModel().getIMUDefinitions();
 for (int i = 0; i < imuDefinitions.length; i++)
 {
   if (imuDefinitions[i].getName().equals(imuName))
    imuDefinition = imuDefinitions[i];
 }
 if (imuDefinition == null)
   throw new RuntimeException("Could not find the IMUDefinition for the imu: " + imuName);
 return imuDefinition;
}
origin: us.ihmc/ihmc-whole-body-controller

public PelvisIMUCheckUpDiagnosticTask(IMUDefinition imuToCheck, DiagnosticControllerToolbox toolbox)
 FullHumanoidRobotModel fullRobotModel = toolbox.getFullRobotModel();
 RigidBodyBasics pelvis = fullRobotModel.getPelvis();
 if (imuToCheck.getRigidBody() != pelvis)
 String nameSuffix = "CheckUp";
 imuSensor = toolbox.getIMUSensorReadOnly(imuName);
 diagnosticParameters = toolbox.getDiagnosticParameters();
 validityChecker = toolbox.getIMUSensorValidityChecker(imuName);
 orientationVelocityConsistency = toolbox.getIMUOrientationAngularVelocityConsistencyChecker(imuName);
 delayEstimator = new DelayEstimatorBetweenTwoSignals(imuName + nameSuffix + "DelayAgainstJointSensors", toolbox.getDT(), registry);
 delayEstimator.setAlphaFilterBreakFrequency(diagnosticParameters.getDelayEstimatorFilterBreakFrequency());
 double maxAbsoluteLead = diagnosticParameters.getDelayEstimatorMaximumLead();
 velocityIMUVsJointDelayStandardDeviation = new YoDouble(imuName + nameSuffix + "VelocityIMUVsJointDelayStandardDeviation", registry);
 YoDouble yoTime = toolbox.getYoTime();
 functionGenerator = new YoFunctionGenerator(imuName + nameSuffix, yoTime, registry);
 functionGenerator.setAmplitude(diagnosticParameters.getCheckUpOscillationPositionAmplitude());
   for (OneDoFJointBasics joint : jointsToWiggle.get(axis))
    jointValidityCheckerList.add(toolbox.getJointSensorValidityChecker(joint));
origin: us.ihmc/IHMCWholeBodyController

public AutomatedDiagnosticAnalysisController(DiagnosticControllerToolbox toolbox, InputStream gainStream, InputStream setpointStream,
   YoVariableRegistry parentRegistry)
 this.yoTime = toolbox.getYoTime();
 this.controlDT = toolbox.getDT();
 FullHumanoidRobotModel fullRobotModel = toolbox.getFullRobotModel();
 DiagnosticParameters diagnosticParameters = toolbox.getDiagnosticParameters();
 for (String jointToIgnore : toolbox.getWalkingControllerParameters().getJointsToIgnoreInController())
origin: us.ihmc/ihmc-whole-body-controller

String nameSuffix = "CheckUp";
registry = new YoVariableRegistry(jointName + nameSuffix);
diagnosticParameters = toolbox.getDiagnosticParameters();
ramp = new YoDouble(jointName + nameSuffix + "SignalRamp", registry);
validityChecker = toolbox.getJointSensorValidityChecker(joint);
positionVelocityConsistency = toolbox.getJointPositionVelocityConsistencyChecker(joint);
forceTrackingDelay = toolbox.getJointForceTrackingDelayEstimator(joint);
fourierAnalysis = toolbox.getJointFourierAnalysis(joint);
forceTrackingDelayStandardDeviation = new YoDouble(jointName + nameSuffix + "ForceTrackingDelayStandardDeviation", registry);
YoDouble yoTime = toolbox.getYoTime();
functionGenerator = new YoFunctionGenerator(jointName + nameSuffix, yoTime, registry);
functionGenerator.setAmplitude(diagnosticParameters.getCheckUpOscillationPositionAmplitude());
origin: us.ihmc/ihmc-avatar-interfaces

public void addJointCheckUpDiagnostic()
 FullHumanoidRobotModel fullRobotModel = toolbox.getFullRobotModel();
 RobotSpecificJointNames robotSpecificJointNames = fullRobotModel.getRobotSpecificJointNames();
 List<String> jointsToIgnore = toolbox.getDiagnosticParameters().getJointsToIgnoreDuringDiagnostic();
origin: us.ihmc/valkyrie

DiagnosticControllerToolbox toolbox = new DiagnosticControllerToolbox(fullRobotModel, estimatorDesiredJointDataHolder, sensorOutputMap,
                                   diagnosticParameters, walkingControllerParameters, diagnosticControllerTime,
                                   diagnosticControllerDT, diagnosticSensorProcessingConfiguration, registry);
origin: us.ihmc/IHMCWholeBodyController

public PelvisIMUCheckUpDiagnosticTask(IMUDefinition imuToCheck, DiagnosticControllerToolbox toolbox)
 FullHumanoidRobotModel fullRobotModel = toolbox.getFullRobotModel();
 RigidBody pelvis = fullRobotModel.getPelvis();
 if (imuToCheck.getRigidBody() != pelvis)
 String nameSuffix = "CheckUp";
 imuSensor = toolbox.getIMUSensorReadOnly(imuName);
 diagnosticParameters = toolbox.getDiagnosticParameters();
 validityChecker = toolbox.getIMUSensorValidityChecker(imuName);
 orientationVelocityConsistency = toolbox.getIMUOrientationAngularVelocityConsistencyChecker(imuName);
 delayEstimator = new DelayEstimatorBetweenTwoSignals(imuName + nameSuffix + "DelayAgainstJointSensors", toolbox.getDT(), registry);
 delayEstimator.setAlphaFilterBreakFrequency(diagnosticParameters.getDelayEstimatorFilterBreakFrequency());
 double maxAbsoluteLead = diagnosticParameters.getDelayEstimatorMaximumLead();
 velocityIMUVsJointDelayStandardDeviation = new DoubleYoVariable(imuName + nameSuffix + "VelocityIMUVsJointDelayStandardDeviation", registry);
 DoubleYoVariable yoTime = toolbox.getYoTime();
 functionGenerator = new YoFunctionGenerator(imuName + nameSuffix, yoTime, registry);
 functionGenerator.setAmplitude(diagnosticParameters.getCheckUpOscillationPositionAmplitude());
   for (OneDoFJoint joint : jointsToWiggle.get(direction))
    jointValidityCheckerList.add(toolbox.getJointSensorValidityChecker(joint));
origin: us.ihmc/ihmc-whole-body-controller

public AutomatedDiagnosticAnalysisController(DiagnosticControllerToolbox toolbox, InputStream gainStream, InputStream setpointStream,
   YoVariableRegistry parentRegistry)
 this.yoTime = toolbox.getYoTime();
 this.controlDT = toolbox.getDT();
 FullHumanoidRobotModel fullRobotModel = toolbox.getFullRobotModel();
 JointDesiredOutputList lowLevelOutput = toolbox.getLowLevelOutput();
 DiagnosticParameters diagnosticParameters = toolbox.getDiagnosticParameters();
 for (String jointToIgnore : toolbox.getWalkingControllerParameters().getJointsToIgnoreInController())
origin: us.ihmc/IHMCWholeBodyController

String nameSuffix = "CheckUp";
registry = new YoVariableRegistry(jointName + nameSuffix);
diagnosticParameters = toolbox.getDiagnosticParameters();
ramp = new DoubleYoVariable(jointName + nameSuffix + "SignalRamp", registry);
validityChecker = toolbox.getJointSensorValidityChecker(joint);
positionVelocityConsistency = toolbox.getJointPositionVelocityConsistencyChecker(joint);
forceTrackingDelay = toolbox.getJointForceTrackingDelayEstimator(joint);
fourierAnalysis = toolbox.getJointFourierAnalysis(joint);
forceTrackingDelayStandardDeviation = new DoubleYoVariable(jointName + nameSuffix + "ForceTrackingDelayStandardDeviation", registry);
DoubleYoVariable yoTime = toolbox.getYoTime();
functionGenerator = new YoFunctionGenerator(jointName + nameSuffix, yoTime, registry);
functionGenerator.setAmplitude(diagnosticParameters.getCheckUpOscillationPositionAmplitude());
origin: us.ihmc/IHMCAvatarInterfaces

public void addJointCheckUpDiagnostic()
 FullHumanoidRobotModel fullRobotModel = toolbox.getFullRobotModel();
 RobotSpecificJointNames robotSpecificJointNames = fullRobotModel.getRobotSpecificJointNames();
 List<String> jointsToIgnore = toolbox.getDiagnosticParameters().getJointsToIgnoreDuringDiagnostic();
origin: us.ihmc/IHMCAvatarInterfaces

public AutomatedDiagnosticConfiguration createDiagnosticController(boolean startWithRobotAlive)
{
 simulatedRobot = robotModel.createHumanoidFloatingRootJointRobot(false);
 DiagnosticLoggerConfiguration.setupLogging(simulatedRobot.getYoTime(), getClass(), robotModel.getSimpleRobotName());
 if (robotInitialSetup == null)
   robotInitialSetup = robotModel.getDefaultRobotInitialSetup(0.0, 0.0);
 robotInitialSetup.initializeRobot(simulatedRobot, robotModel.getJointMap());
 FullHumanoidRobotModel fullRobotModel = robotModel.createFullRobotModel();
 WalkingControllerParameters walkingControllerParameters = robotModel.getWalkingControllerParameters();
 DoubleYoVariable yoTime = simulatedRobot.getYoTime();
 double dt = robotModel.getEstimatorDT();
 StateEstimatorParameters stateEstimatorParameters = robotModel.getStateEstimatorParameters();
 if (diagnosticParameters == null)
   diagnosticParameters = new DiagnosticParameters(DiagnosticEnvironment.RUNTIME_CONTROLLER, false);
 DiagnosticSensorProcessingConfiguration sensorProcessingConfiguration = new DiagnosticSensorProcessingConfiguration(diagnosticParameters, stateEstimatorParameters);
 SensorOutputMapReadOnly sensorOutputMap = createStateEstimator(fullRobotModel, stateEstimatorParameters, sensorProcessingConfiguration);
 DiagnosticControllerToolbox diagnosticControllerToolbox = new DiagnosticControllerToolbox(fullRobotModel, sensorOutputMap, diagnosticParameters, walkingControllerParameters, yoTime, dt,
    sensorProcessingConfiguration, simulationRegistry);
 automatedDiagnosticAnalysisController = new AutomatedDiagnosticAnalysisController(diagnosticControllerToolbox, gainStream, setpointStream,
    simulationRegistry);
 automatedDiagnosticAnalysisController.setRobotIsAlive(startWithRobotAlive);
 automatedDiagnosticConfiguration = new AutomatedDiagnosticConfiguration(diagnosticControllerToolbox, automatedDiagnosticAnalysisController);
 outputWriter = new DRCSimulationOutputWriter(simulatedRobot);
 outputWriter.setFullRobotModel(fullRobotModel, null);
 int simulationTicksPerControlTick = (int) (robotModel.getEstimatorDT() / robotModel.getSimulateDT());
 simulatedRobot.setController(this, simulationTicksPerControlTick);
 return automatedDiagnosticConfiguration;
}
origin: us.ihmc/DarpaRoboticsChallenge

public void addJointCheckUpDiagnostic()
 FullHumanoidRobotModel fullRobotModel = toolbox.getFullRobotModel();
 RobotSpecificJointNames robotSpecificJointNames = fullRobotModel.getRobotSpecificJointNames();
 List<String> jointsToIgnore = toolbox.getDiagnosticParameters().getJointsToIgnoreDuringDiagnostic();
origin: us.ihmc/IHMCAvatarInterfaces

public AutomatedDiagnosticConfiguration(DiagnosticControllerToolbox toolbox, AutomatedDiagnosticAnalysisController diagnosticController)
{
 this.toolbox = toolbox;
 this.diagnosticController = diagnosticController;
 enableLogging = toolbox.getDiagnosticParameters().enableLogging();
}
origin: us.ihmc/DarpaRoboticsChallenge

public AutomatedDiagnosticConfiguration createDiagnosticController(boolean startWithRobotAlive)
{
 simulatedRobot = robotModel.createHumanoidFloatingRootJointRobot(false);
 DiagnosticLoggerConfiguration.setupLogging(simulatedRobot.getYoTime(), getClass(), robotModel.getSimpleRobotName());
 if (robotInitialSetup == null)
   robotInitialSetup = robotModel.getDefaultRobotInitialSetup(0.0, 0.0);
 robotInitialSetup.initializeRobot(simulatedRobot, robotModel.getJointMap());
 FullHumanoidRobotModel fullRobotModel = robotModel.createFullRobotModel();
 WalkingControllerParameters walkingControllerParameters = robotModel.getWalkingControllerParameters();
 DoubleYoVariable yoTime = simulatedRobot.getYoTime();
 double dt = robotModel.getEstimatorDT();
 StateEstimatorParameters stateEstimatorParameters = robotModel.getStateEstimatorParameters();
 if (diagnosticParameters == null)
   diagnosticParameters = new DiagnosticParameters(DiagnosticEnvironment.RUNTIME_CONTROLLER, false);
 DiagnosticSensorProcessingConfiguration sensorProcessingConfiguration = new DiagnosticSensorProcessingConfiguration(diagnosticParameters, stateEstimatorParameters);
 SensorOutputMapReadOnly sensorOutputMap = createStateEstimator(fullRobotModel, stateEstimatorParameters, sensorProcessingConfiguration);
 DiagnosticControllerToolbox diagnosticControllerToolbox = new DiagnosticControllerToolbox(fullRobotModel, sensorOutputMap, diagnosticParameters, walkingControllerParameters, yoTime, dt,
    sensorProcessingConfiguration, simulationRegistry);
 automatedDiagnosticAnalysisController = new AutomatedDiagnosticAnalysisController(diagnosticControllerToolbox, gainStream, setpointStream,
    simulationRegistry);
 automatedDiagnosticAnalysisController.setRobotIsAlive(startWithRobotAlive);
 automatedDiagnosticConfiguration = new AutomatedDiagnosticConfiguration(diagnosticControllerToolbox, automatedDiagnosticAnalysisController);
 outputWriter = new DRCSimulationOutputWriter(simulatedRobot);
 outputWriter.setFullRobotModel(fullRobotModel, null);
 int simulationTicksPerControlTick = (int) (robotModel.getEstimatorDT() / robotModel.getSimulateDT());
 simulatedRobot.setController(this, simulationTicksPerControlTick);
 return automatedDiagnosticConfiguration;
}
origin: us.ihmc/ihmc-whole-body-controller

private static IMUDefinition findIMUDefinition(String imuName, DiagnosticControllerToolbox toolbox)
{
 IMUDefinition imuDefinition = null;
 IMUDefinition[] imuDefinitions = toolbox.getFullRobotModel().getIMUDefinitions();
 for (int i = 0; i < imuDefinitions.length; i++)
 {
   if (imuDefinitions[i].getName().equals(imuName))
    imuDefinition = imuDefinitions[i];
 }
 if (imuDefinition == null)
   throw new RuntimeException("Could not find the IMUDefinition for the imu: " + imuName);
 return imuDefinition;
}
origin: us.ihmc/DarpaRoboticsChallenge

public AutomatedDiagnosticConfiguration(DiagnosticControllerToolbox toolbox, AutomatedDiagnosticAnalysisController diagnosticController)
{
 this.toolbox = toolbox;
 this.diagnosticController = diagnosticController;
 enableLogging = toolbox.getDiagnosticParameters().enableLogging();
}
origin: us.ihmc/ihmc-avatar-interfaces

public AutomatedDiagnosticConfiguration createDiagnosticController(boolean startWithRobotAlive)
{
 simulatedRobot = robotModel.createHumanoidFloatingRootJointRobot(false);
 DiagnosticLoggerConfiguration.setupLogging(simulatedRobot.getYoTime(), getClass(), robotModel.getSimpleRobotName());
 if (robotInitialSetup == null)
   robotInitialSetup = robotModel.getDefaultRobotInitialSetup(0.0, 0.0);
 robotInitialSetup.initializeRobot(simulatedRobot, robotModel.getJointMap());
 FullHumanoidRobotModel fullRobotModel = robotModel.createFullRobotModel();
 WalkingControllerParameters walkingControllerParameters = robotModel.getWalkingControllerParameters();
 YoDouble yoTime = simulatedRobot.getYoTime();
 double dt = robotModel.getEstimatorDT();
 StateEstimatorParameters stateEstimatorParameters = robotModel.getStateEstimatorParameters();
 if (diagnosticParameters == null)
   diagnosticParameters = new DiagnosticParameters(DiagnosticEnvironment.RUNTIME_CONTROLLER, false);
 JointDesiredOutputList lowLevelOutput = new JointDesiredOutputList(fullRobotModel.getOneDoFJoints());
 DiagnosticSensorProcessingConfiguration sensorProcessingConfiguration = new DiagnosticSensorProcessingConfiguration(diagnosticParameters, stateEstimatorParameters, lowLevelOutput);
 SensorOutputMapReadOnly sensorOutputMap = createStateEstimator(fullRobotModel, stateEstimatorParameters, sensorProcessingConfiguration);
 DiagnosticControllerToolbox diagnosticControllerToolbox = new DiagnosticControllerToolbox(fullRobotModel, lowLevelOutput, sensorOutputMap, diagnosticParameters, walkingControllerParameters, yoTime, dt,
    sensorProcessingConfiguration, simulationRegistry);
 automatedDiagnosticAnalysisController = new AutomatedDiagnosticAnalysisController(diagnosticControllerToolbox, gainStream, setpointStream,
    simulationRegistry);
 automatedDiagnosticAnalysisController.setRobotIsAlive(startWithRobotAlive);
 automatedDiagnosticConfiguration = new AutomatedDiagnosticConfiguration(diagnosticControllerToolbox, automatedDiagnosticAnalysisController);
 lowLevelOutputWriter = new SimulatedLowLevelOutputWriter(simulatedRobot, false);
 lowLevelOutputWriter.setJointDesiredOutputList(lowLevelOutput);
 int simulationTicksPerControlTick = (int) (robotModel.getEstimatorDT() / robotModel.getSimulateDT());
 simulatedRobot.setController(this, simulationTicksPerControlTick);
 return automatedDiagnosticConfiguration;
}
origin: us.ihmc/DarpaRoboticsChallenge

  public void addPelvisIMUCheckUpDiagnostic()
  {
   DiagnosticParameters diagnosticParameters = toolbox.getDiagnosticParameters();
   String pelvisIMUName = diagnosticParameters.getPelvisIMUName();
   if (pelvisIMUName == null || pelvisIMUName.isEmpty())
   {
     System.err.println(getClass().getSimpleName() + ": Cannot create the pelvis IMU check up diagnostic without a pelvisIMUName to look for.");
     return;
   }

   PelvisIMUCheckUpDiagnosticTask checkUp = new PelvisIMUCheckUpDiagnosticTask(pelvisIMUName, toolbox);
   if (enableLogging)
     checkUp.setupForLogging();
   diagnosticController.submitDiagnostic(checkUp);
  }
}
origin: us.ihmc/IHMCAvatarInterfaces

  public void addPelvisIMUCheckUpDiagnostic()
  {
   DiagnosticParameters diagnosticParameters = toolbox.getDiagnosticParameters();
   String pelvisIMUName = diagnosticParameters.getPelvisIMUName();
   if (pelvisIMUName == null || pelvisIMUName.isEmpty())
   {
     System.err.println(getClass().getSimpleName() + ": Cannot create the pelvis IMU check up diagnostic without a pelvisIMUName to look for.");
     return;
   }

   PelvisIMUCheckUpDiagnosticTask checkUp = new PelvisIMUCheckUpDiagnosticTask(pelvisIMUName, toolbox);
   if (enableLogging)
     checkUp.setupForLogging();
   diagnosticController.submitDiagnostic(checkUp);
  }
}
us.ihmc.wholeBodyController.diagnosticsDiagnosticControllerToolbox

Most used methods

  • getDiagnosticParameters
  • getFullRobotModel
  • <init>
  • getDT
  • getIMUOrientationAngularVelocityConsistencyChecker
  • getIMUSensorReadOnly
  • getIMUSensorValidityChecker
  • getJointForceTrackingDelayEstimator
  • getJointFourierAnalysis
  • getJointPositionVelocityConsistencyChecker
  • getJointSensorValidityChecker
  • getWalkingControllerParameters
  • getJointSensorValidityChecker,
  • getWalkingControllerParameters,
  • getYoTime,
  • getLowLevelOutput

Popular in Java

  • Parsing JSON documents to java classes using gson
  • getSharedPreferences (Context)
  • addToBackStack (FragmentTransaction)
  • onCreateOptionsMenu (Activity)
  • InputStreamReader (java.io)
    A class for turning a byte stream into a character stream. Data read from the source input stream is
  • BigDecimal (java.math)
    An immutable arbitrary-precision signed decimal.A value is represented by an arbitrary-precision "un
  • Socket (java.net)
    Provides a client-side TCP socket.
  • Date (java.sql)
    A class which can consume and produce dates in SQL Date format. Dates are represented in SQL as yyyy
  • HttpServlet (javax.servlet.http)
    Provides an abstract class to be subclassed to create an HTTP servlet suitable for a Web site. A sub
  • LogFactory (org.apache.commons.logging)
    Factory for creating Log instances, with discovery and configuration features similar to that employ
  • Best IntelliJ 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