wip: checkpoint paused Go2 FL four-skill development
This commit is contained in:
@@ -0,0 +1,44 @@
|
||||
"""Public-interface examples for an already supervised four-skill runtime.
|
||||
|
||||
`advance` is the certified owner's one-control-step callback. It owns actor
|
||||
inference,500Hz safety/evidence, deadlines and cleanup. The central client below
|
||||
never receives desired support loads or sampled force parameters, and cannot
|
||||
reset/teleport the robot. Do not construct an unsupervised Kit here.
|
||||
"""
|
||||
from SkillFactory.legs.four_skills.api import CentralComposer
|
||||
|
||||
|
||||
def compose(service, advance, *, direction_m=(.024, .010), holds_s=(.5, .3, .4, .5), loops=5):
|
||||
program = CentralComposer(service, {'direction_m': direction_m, 'holds_s': holds_s, 'loops': loops})
|
||||
for _ in range(12000):
|
||||
if program.update():
|
||||
return {'completed_loops': program.completed_loops, 'safe_stop': program.safely_stopped,
|
||||
'status': service.query()}
|
||||
advance()
|
||||
service.request_stop()
|
||||
raise TimeoutError('Central command budget exhausted; owner must finish safe cleanup')
|
||||
|
||||
|
||||
def hold_then_switch(service, advance):
|
||||
"""Illustrate calls individually; all transitions use actual ready feedback."""
|
||||
def wait():
|
||||
for _ in range(2000):
|
||||
status = service.query()
|
||||
if status['failed']:
|
||||
raise RuntimeError(str(status['failure_reasons']))
|
||||
if status['ready'] and status['hold_complete']:
|
||||
return status
|
||||
advance()
|
||||
raise TimeoutError('Skill feedback not ready; no forced transition or state overwrite')
|
||||
service.hold(.8)
|
||||
wait()
|
||||
service.call('retract', hold_seconds=.5)
|
||||
wait()
|
||||
service.switch('swing', direction_m=[.020, .024], hold_seconds=1.)
|
||||
wait()
|
||||
service.call('plant', hold_seconds=.7)
|
||||
wait()
|
||||
service.call('support', hold_seconds=.8)
|
||||
wait()
|
||||
service.request_stop()
|
||||
return service.query()
|
||||
Reference in New Issue
Block a user