2023-10-25 10:34:46 +08:00
|
|
|
|
"""
|
|
|
|
|
|
在特定环境下，机器人发现目标，可自主完成任务
|
|
|
|
|
|
1. 打扫地面：地面有垃圾，机器人主动扫地、清理地面垃圾
|
|
|
|
|
|
2. 收拾桌子：桌子上的污渍，机器人主动擦桌子
|
|
|
|
|
|
3. 摆椅子：椅子不正，机器人主动摆正椅子
|
|
|
|
|
|
4. 开灯：室内光线暗，机器人主动打开房屋的灯
|
|
|
|
|
|
"""
|
|
|
|
|
|
|
|
|
|
|
|
# todo: 通过行为树控制自动任务
|
|
|
|
|
|
|
|
|
|
|
|
from robowaiter.scene.scene import Scene
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
class SceneAT(Scene):
|
|
|
|
|
|
def __init__(self, robot):
|
|
|
|
|
|
super().__init__(robot)
|
|
|
|
|
|
|
2023-10-25 22:12:15 +08:00
|
|
|
|
def _reset(self):
|
2023-11-16 15:04:27 +08:00
|
|
|
|
# self.add_walker(1085, 2630, 220)
|
|
|
|
|
|
# self.control_walker([self.walker_control_generator(0, False, 100, 755, 1900, 180)])
|
|
|
|
|
|
pass
|
2023-10-25 10:34:46 +08:00
|
|
|
|
|
2023-10-25 22:12:15 +08:00
|
|
|
|
def _run(self):
|
2023-11-15 14:30:55 +08:00
|
|
|
|
|
|
|
|
|
|
self.move_task_area(7)
|
|
|
|
|
|
self.op_task_execute(7)
|
|
|
|
|
|
self.move_task_area(6)
|
|
|
|
|
|
self.op_task_execute(6)
|
2023-10-25 22:12:15 +08:00
|
|
|
|
pass
|
2023-10-25 10:34:46 +08:00
|
|
|
|
|
2023-10-25 22:12:15 +08:00
|
|
|
|
def _step(self):
|
2023-11-15 14:30:55 +08:00
|
|
|
|
pass
|
|
|
|
|
|
|
|
|
|
|
|
if __name__ == '__main__':
|
|
|
|
|
|
from robowaiter.robot.robot import Robot
|
|
|
|
|
|
|
|
|
|
|
|
robot = Robot()
|
|
|
|
|
|
|
|
|
|
|
|
# create task
|
|
|
|
|
|
task = SceneAT(robot)
|
|
|
|
|
|
task.reset()
|
|
|
|
|
|
task.run()
|
