37 lines
995 B
Python
37 lines
995 B
Python
|
"""
|
|||
|
视觉语言操作
|
|||
|
机器人根据指令人的指令调节空调,自主探索环境导航到目标点,通过手臂的运动规划能力操作空调,比如开关按钮、调温按钮、显示面板
|
|||
|
"""
|
|||
|
|
|||
|
import time
|
|||
|
from robowaiter.scene.scene import Scene
|
|||
|
|
|||
|
|
|||
|
class SceneVLM(Scene):
|
|||
|
def __init__(self, robot):
|
|||
|
super().__init__(robot)
|
|||
|
|
|||
|
def reset(self):
|
|||
|
self.reset_sim()
|
|||
|
|
|||
|
self.add_walker(1085, 2630, 220)
|
|||
|
self.control_walker([self.walker_control_generator(0, False, 100, 755, 1900, 180)])
|
|||
|
|
|||
|
def run(self):
|
|||
|
# 空调操作
|
|||
|
self.walk_to(950, 1260, 90) # 没法转向?
|
|||
|
# todo: 手臂操作
|
|||
|
time.sleep(5)
|
|||
|
self.walk_to(947, 1900, 0)
|
|||
|
|
|||
|
# 物品挪动
|
|||
|
# todo: 视觉导航至目标点,操作手臂至可抓位置
|
|||
|
"""
|
|||
|
scene.grasp(1, your_objectID)
|
|||
|
"""
|
|||
|
|
|||
|
# todo: 视觉导航至目标点,找准释放位置
|
|||
|
"""
|
|||
|
scene.release(1)
|
|||
|
"""
|