|
|
@ -2829,9 +2829,9 @@ class G1Deploy { |
|
|
MotorCommand motor_command_tmp; |
|
|
MotorCommand motor_command_tmp; |
|
|
|
|
|
|
|
|
// Neutral hold mode: bypass NN, command default angles directly (key 'n')
|
|
|
// Neutral hold mode: bypass NN, command default angles directly (key 'n')
|
|
|
// Uses 3x gains for firm hold — useful for visual joint calibration.
|
|
|
|
|
|
|
|
|
// Uses 2x gains for firm hold — useful for visual joint calibration.
|
|
|
if (g_neutral_hold_mode.load()) { |
|
|
if (g_neutral_hold_mode.load()) { |
|
|
constexpr float neutral_gain_mult = 3.0f; |
|
|
|
|
|
|
|
|
constexpr float neutral_gain_mult = 2.0f; |
|
|
for (int i = 0; i < G1_NUM_MOTOR; i++) { |
|
|
for (int i = 0; i < G1_NUM_MOTOR; i++) { |
|
|
motor_command_tmp.q_target.at(i) = static_cast<float>(default_angles[i]); |
|
|
motor_command_tmp.q_target.at(i) = static_cast<float>(default_angles[i]); |
|
|
motor_command_tmp.tau_ff.at(i) = 0.0; |
|
|
motor_command_tmp.tau_ff.at(i) = 0.0; |
|
|
|