#include <op3_balance_control.h>
Public Member Functions | |
BalanceControlUsingPDController () | |
double | getCOBManualAdjustmentX () |
double | getCOBManualAdjustmentY () |
double | getCOBManualAdjustmentZ () |
void | initialize (const int control_cycle_msec) |
void | process (int *balance_error, Eigen::MatrixXd *robot_to_cob_modified, Eigen::MatrixXd *robot_to_right_foot_modified, Eigen::MatrixXd *robot_to_left_foot_modified) |
void | setCOBManualAdjustment (double cob_x_adjustment_m, double cob_y_adjustment_m, double cob_z_adjustment_m) |
void | setCurrentFootForceTorqueSensorOutput (double r_force_x_N, double r_force_y_N, double r_force_z_N, double r_torque_roll_Nm, double r_torque_pitch_Nm, double r_torque_yaw_Nm, double l_force_x_N, double l_force_y_N, double l_force_z_N, double l_torque_roll_Nm, double l_torque_pitch_Nm, double l_torque_yaw_Nm) |
void | setCurrentGyroSensorOutput (double gyro_roll, double gyro_pitch) |
void | setCurrentOrientationSensorOutput (double cob_orientation_roll, double cob_orientation_pitch) |
void | setDesiredCOBGyro (double gyro_roll, double gyro_pitch) |
void | setDesiredCOBOrientation (double cob_orientation_roll, double cob_orientation_pitch) |
void | setDesiredFootForceTorque (double r_force_x_N, double r_force_y_N, double r_force_z_N, double r_torque_roll_Nm, double r_torque_pitch_Nm, double r_torque_yaw_Nm, double l_force_x_N, double l_force_y_N, double l_force_z_N, double l_torque_roll_Nm, double l_torque_pitch_Nm, double l_torque_yaw_Nm) |
void | setDesiredPose (const Eigen::MatrixXd &robot_to_cob, const Eigen::MatrixXd &robot_to_right_foot, const Eigen::MatrixXd &robot_to_left_foot) |
void | setForceTorqueBalanceEnable (bool enable) |
void | setGyroBalanceEnable (bool enable) |
void | setMaximumAdjustment (double cob_x_max_adjustment_m, double cob_y_max_adjustment_m, double cob_z_max_adjustment_m, double cob_roll_max_adjustment_rad, double cob_pitch_max_adjustment_rad, double cob_yaw_max_adjustment_rad, double foot_x_max_adjustment_m, double foot_y_max_adjustment_m, double foot_z_max_adjustment_m, double foot_roll_max_adjustment_rad, double foot_pitch_max_adjustment_rad, double foot_yaw_max_adjustment_rad) |
void | setOrientationBalanceEnable (bool enable) |
~BalanceControlUsingPDController () | |
Definition at line 249 of file op3_balance_control.h.
BalanceControlUsingPDController::BalanceControlUsingPDController | ( | ) |
Definition at line 548 of file op3_balance_control.cpp.
BalanceControlUsingPDController::~BalanceControlUsingPDController | ( | ) |
Definition at line 619 of file op3_balance_control.cpp.
double BalanceControlUsingPDController::getCOBManualAdjustmentX | ( | ) |
Definition at line 921 of file op3_balance_control.cpp.
double BalanceControlUsingPDController::getCOBManualAdjustmentY | ( | ) |
Definition at line 926 of file op3_balance_control.cpp.
double BalanceControlUsingPDController::getCOBManualAdjustmentZ | ( | ) |
Definition at line 931 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::initialize | ( | const int | control_cycle_msec | ) |
Definition at line 622 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::process | ( | int * | balance_error, |
Eigen::MatrixXd * | robot_to_cob_modified, | ||
Eigen::MatrixXd * | robot_to_right_foot_modified, | ||
Eigen::MatrixXd * | robot_to_left_foot_modified | ||
) |
Definition at line 675 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setCOBManualAdjustment | ( | double | cob_x_adjustment_m, |
double | cob_y_adjustment_m, | ||
double | cob_z_adjustment_m | ||
) |
Definition at line 914 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setCurrentFootForceTorqueSensorOutput | ( | double | r_force_x_N, |
double | r_force_y_N, | ||
double | r_force_z_N, | ||
double | r_torque_roll_Nm, | ||
double | r_torque_pitch_Nm, | ||
double | r_torque_yaw_Nm, | ||
double | l_force_x_N, | ||
double | l_force_y_N, | ||
double | l_force_z_N, | ||
double | l_torque_roll_Nm, | ||
double | l_torque_pitch_Nm, | ||
double | l_torque_yaw_Nm | ||
) |
Definition at line 873 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setCurrentGyroSensorOutput | ( | double | gyro_roll, |
double | gyro_pitch | ||
) |
Definition at line 861 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setCurrentOrientationSensorOutput | ( | double | cob_orientation_roll, |
double | cob_orientation_pitch | ||
) |
Definition at line 867 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setDesiredCOBGyro | ( | double | gyro_roll, |
double | gyro_pitch | ||
) |
Definition at line 830 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setDesiredCOBOrientation | ( | double | cob_orientation_roll, |
double | cob_orientation_pitch | ||
) |
Definition at line 836 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setDesiredFootForceTorque | ( | double | r_force_x_N, |
double | r_force_y_N, | ||
double | r_force_z_N, | ||
double | r_torque_roll_Nm, | ||
double | r_torque_pitch_Nm, | ||
double | r_torque_yaw_Nm, | ||
double | l_force_x_N, | ||
double | l_force_y_N, | ||
double | l_force_z_N, | ||
double | l_torque_roll_Nm, | ||
double | l_torque_pitch_Nm, | ||
double | l_torque_yaw_Nm | ||
) |
Definition at line 842 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setDesiredPose | ( | const Eigen::MatrixXd & | robot_to_cob, |
const Eigen::MatrixXd & | robot_to_right_foot, | ||
const Eigen::MatrixXd & | robot_to_left_foot | ||
) |
Definition at line 823 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setForceTorqueBalanceEnable | ( | bool | enable | ) |
Definition at line 667 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setGyroBalanceEnable | ( | bool | enable | ) |
Definition at line 651 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setMaximumAdjustment | ( | double | cob_x_max_adjustment_m, |
double | cob_y_max_adjustment_m, | ||
double | cob_z_max_adjustment_m, | ||
double | cob_roll_max_adjustment_rad, | ||
double | cob_pitch_max_adjustment_rad, | ||
double | cob_yaw_max_adjustment_rad, | ||
double | foot_x_max_adjustment_m, | ||
double | foot_y_max_adjustment_m, | ||
double | foot_z_max_adjustment_m, | ||
double | foot_roll_max_adjustment_rad, | ||
double | foot_pitch_max_adjustment_rad, | ||
double | foot_yaw_max_adjustment_rad | ||
) |
Definition at line 894 of file op3_balance_control.cpp.
void BalanceControlUsingPDController::setOrientationBalanceEnable | ( | bool | enable | ) |
Definition at line 659 of file op3_balance_control.cpp.
|
private |
Definition at line 334 of file op3_balance_control.h.
|
private |
Definition at line 396 of file op3_balance_control.h.
|
private |
Definition at line 395 of file op3_balance_control.h.
|
private |
Definition at line 392 of file op3_balance_control.h.
|
private |
Definition at line 358 of file op3_balance_control.h.
|
private |
Definition at line 393 of file op3_balance_control.h.
|
private |
Definition at line 359 of file op3_balance_control.h.
|
private |
Definition at line 397 of file op3_balance_control.h.
|
private |
Definition at line 394 of file op3_balance_control.h.
|
private |
Definition at line 360 of file op3_balance_control.h.
|
private |
Definition at line 335 of file op3_balance_control.h.
|
private |
Definition at line 348 of file op3_balance_control.h.
|
private |
Definition at line 348 of file op3_balance_control.h.
|
private |
Definition at line 354 of file op3_balance_control.h.
|
private |
Definition at line 354 of file op3_balance_control.h.
|
private |
Definition at line 354 of file op3_balance_control.h.
|
private |
Definition at line 355 of file op3_balance_control.h.
|
private |
Definition at line 355 of file op3_balance_control.h.
|
private |
Definition at line 355 of file op3_balance_control.h.
|
private |
Definition at line 350 of file op3_balance_control.h.
|
private |
Definition at line 350 of file op3_balance_control.h.
|
private |
Definition at line 352 of file op3_balance_control.h.
|
private |
Definition at line 352 of file op3_balance_control.h.
|
private |
Definition at line 352 of file op3_balance_control.h.
|
private |
Definition at line 353 of file op3_balance_control.h.
|
private |
Definition at line 353 of file op3_balance_control.h.
|
private |
Definition at line 353 of file op3_balance_control.h.
|
private |
Definition at line 343 of file op3_balance_control.h.
|
private |
Definition at line 345 of file op3_balance_control.h.
|
private |
Definition at line 344 of file op3_balance_control.h.
|
private |
Definition at line 403 of file op3_balance_control.h.
|
private |
Definition at line 364 of file op3_balance_control.h.
|
private |
Definition at line 367 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::foot_pitch_angle_ctrl_ |
Definition at line 300 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::foot_pitch_gyro_ctrl_ |
Definition at line 298 of file op3_balance_control.h.
|
private |
Definition at line 402 of file op3_balance_control.h.
|
private |
Definition at line 363 of file op3_balance_control.h.
|
private |
Definition at line 366 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::foot_roll_angle_ctrl_ |
Definition at line 299 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::foot_roll_gyro_ctrl_ |
Definition at line 297 of file op3_balance_control.h.
|
private |
Definition at line 399 of file op3_balance_control.h.
|
private |
Definition at line 400 of file op3_balance_control.h.
|
private |
Definition at line 404 of file op3_balance_control.h.
|
private |
Definition at line 401 of file op3_balance_control.h.
|
private |
Definition at line 340 of file op3_balance_control.h.
|
private |
Definition at line 338 of file op3_balance_control.h.
|
private |
Definition at line 380 of file op3_balance_control.h.
|
private |
Definition at line 379 of file op3_balance_control.h.
|
private |
Definition at line 377 of file op3_balance_control.h.
|
private |
Definition at line 378 of file op3_balance_control.h.
|
private |
Definition at line 370 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::left_foot_force_x_ctrl_ |
Definition at line 310 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::left_foot_force_x_lpf_ |
Definition at line 327 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::left_foot_force_y_ctrl_ |
Definition at line 311 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::left_foot_force_y_lpf_ |
Definition at line 328 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::left_foot_force_z_ctrl_ |
Definition at line 303 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::left_foot_force_z_lpf_ |
Definition at line 329 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::left_foot_torque_pitch_ctrl_ |
Definition at line 313 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::left_foot_torque_pitch_lpf_ |
Definition at line 331 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::left_foot_torque_roll_ctrl_ |
Definition at line 312 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::left_foot_torque_roll_lpf_ |
Definition at line 330 of file op3_balance_control.h.
|
private |
Definition at line 387 of file op3_balance_control.h.
|
private |
Definition at line 389 of file op3_balance_control.h.
|
private |
Definition at line 388 of file op3_balance_control.h.
|
private |
Definition at line 339 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::pitch_angle_lpf_ |
Definition at line 319 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::pitch_gyro_lpf_ |
Definition at line 316 of file op3_balance_control.h.
|
private |
Definition at line 383 of file op3_balance_control.h.
|
private |
Definition at line 385 of file op3_balance_control.h.
|
private |
Definition at line 384 of file op3_balance_control.h.
|
private |
Definition at line 375 of file op3_balance_control.h.
|
private |
Definition at line 374 of file op3_balance_control.h.
|
private |
Definition at line 372 of file op3_balance_control.h.
|
private |
Definition at line 373 of file op3_balance_control.h.
|
private |
Definition at line 369 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::right_foot_force_x_ctrl_ |
Definition at line 305 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::right_foot_force_x_lpf_ |
Definition at line 321 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::right_foot_force_y_ctrl_ |
Definition at line 306 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::right_foot_force_y_lpf_ |
Definition at line 322 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::right_foot_force_z_ctrl_ |
Definition at line 302 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::right_foot_force_z_lpf_ |
Definition at line 323 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::right_foot_torque_pitch_ctrl_ |
Definition at line 308 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::right_foot_torque_pitch_lpf_ |
Definition at line 325 of file op3_balance_control.h.
BalancePDController robotis_op::BalanceControlUsingPDController::right_foot_torque_roll_ctrl_ |
Definition at line 307 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::right_foot_torque_roll_lpf_ |
Definition at line 324 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::roll_angle_lpf_ |
Definition at line 318 of file op3_balance_control.h.
BalanceLowPassFilter robotis_op::BalanceControlUsingPDController::roll_gyro_lpf_ |
Definition at line 315 of file op3_balance_control.h.