hyq_path_planner.py 1.12 KB
Newer Older
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
from .abstract_path_planner import AbstractPathPlanner


class HyqPathPlanner(AbstractPathPlanner):

    def __init__(self):
        super().__init__()
        # set default bounds to a large workspace on x,y with small interval around reference z value
        self.root_translation_bounds = [-5., 5., -5., 5., 0.5, 0.75]
        # set default used limbs to be both feet
        self.used_limbs = ['hyq_rhleg_rom', 'hyq_lfleg_rom', 'hyq_rfleg_rom','hyq_lhleg_rom']
        self.size_foot_x = 0.01 # size of the feet along the x axis
        self.size_foot_y = 0.01  # size of the feet along the y axis
        self.v_max = 0.3
        self.a_max = 0.1
        self.extra_dof_bounds = [-self.v_max, self.v_max, -self.v_max, self.v_max, 0, 0,
                                 -self.a_max, self.a_max, -self.a_max, self.a_max, 0, 0]
        self.robot_node_name = "hyq_trunk_large"

    def load_rbprm(self):
        from hpp.corbaserver.rbprm.hyq_abstract import Robot
        self.rbprmBuilder = Robot()

    def set_joints_bounds(self):
        super().set_joints_bounds()


    def set_configurations(self):
        super().set_configurations()