减小安全约束
This commit is contained in:
@@ -34,6 +34,10 @@ def main():
|
||||
p.add_argument('--duration', type=float, default=60)
|
||||
p.add_argument('--hip-range', type=float, default=0.4, help='hip 摆幅 (rad)')
|
||||
p.add_argument('--thigh-range', type=float, default=0.5, help='thigh 摆幅 (rad)')
|
||||
p.add_argument('--power-factor', type=int, default=3,
|
||||
help='PowerProtect 1-10 (默认 3 = 30%% 力矩)')
|
||||
p.add_argument('--pos-protect', type=float, default=None,
|
||||
help='软位置保护阈值 rad (默认 None = 关闭, 摇杆遥控时建议关闭避免误触发)')
|
||||
args = p.parse_args()
|
||||
signal.signal(signal.SIGINT, sigint)
|
||||
|
||||
@@ -72,8 +76,8 @@ def main():
|
||||
mode=MotorMode.Servo, q=q, dq=0, tau=0, Kp=3, Kd=0.5)
|
||||
|
||||
try:
|
||||
apply_safety(cmd, state, power_factor=1,
|
||||
position_protect_limit=0.5)
|
||||
apply_safety(cmd, state, power_factor=args.power_factor,
|
||||
position_protect_limit=args.pos_protect)
|
||||
except PowerProtectViolation as e:
|
||||
print(f'\n⚠️ {e}')
|
||||
break
|
||||
|
||||
Reference in New Issue
Block a user