Skip to content

locomotion_robot

LocomotionRobot

Bases: BaseRobot

Robot that is is equipped with locomotive (navigational) capabilities. Provides common interface for a wide variety of robots.

controller_config should, at the minimum, contain:

base: controller specifications for the controller to control this robot's base (locomotion). Should include:

- name: Controller to create
- <other kwargs> relevant to the controller being created. Note that all values will have default
    values specified, but setting these individual kwargs will override them
Source code in omnigibson/robots/locomotion_robot.py 
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
class LocomotionRobot(BaseRobot):
    """
    Robot that is is equipped with locomotive (navigational) capabilities.
    Provides common interface for a wide variety of robots.

    NOTE: controller_config should, at the minimum, contain:
        base: controller specifications for the controller to control this robot's base (locomotion).
            Should include:

            - name: Controller to create
            - <other kwargs> relevant to the controller being created. Note that all values will have default
                values specified, but setting these individual kwargs will override them

    """

    def _validate_configuration(self):
        # We make sure that our base controller exists and is a locomotion controller
        assert (
            "base" in self._controllers
        ), "Controller 'base' must exist in controllers! Current controllers: {}".format(list(self._controllers.keys()))
        assert isinstance(
            self._controllers["base"], LocomotionController
        ), "Base controller must be a LocomotionController!"

        # run super
        super()._validate_configuration()

    def _get_proprioception_dict(self):
        dic = super()._get_proprioception_dict()

        joint_positions = self.get_joint_positions(normalized=False)
        joint_velocities = self.get_joint_velocities(normalized=False)

        # Add base info
        dic["base_qpos"] = joint_positions[self.base_control_idx]
        dic["base_qpos_sin"] = np.sin(joint_positions[self.base_control_idx])
        dic["base_qpos_cos"] = np.cos(joint_positions[self.base_control_idx])
        dic["base_qvel"] = joint_velocities[self.base_control_idx]

        return dic

    @property
    def default_proprio_obs(self):
        obs_keys = super().default_proprio_obs
        return obs_keys + ["base_qpos_sin", "base_qpos_cos", "robot_lin_vel", "robot_ang_vel"]

    @property
    def controller_order(self):
        # By default, only base is supported
        return ["base"]

    @property
    def _default_controllers(self):
        # Always call super first
        controllers = super()._default_controllers

        # For best generalizability use, joint controller as default
        controllers["base"] = "JointController"

        return controllers

    @property
    def _default_base_joint_controller_config(self):
        """
        Returns:
            dict: Default base joint controller config to control this robot's base. Uses velocity
                control by default.
        """
        return {
            "name": "JointController",
            "control_freq": self._control_freq,
            "motor_type": "velocity",
            "control_limits": self.control_limits,
            "dof_idx": self.base_control_idx,
            "command_output_limits": "default",
            "use_delta_commands": False,
        }

    @property
    def _default_base_null_joint_controller_config(self):
        """
        Returns:
            dict: Default null joint controller config to control this robot's base i.e. dummy controller
        """
        return {
            "name": "NullJointController",
            "control_freq": self._control_freq,
            "motor_type": "velocity",
            "control_limits": self.control_limits,
            "dof_idx": self.base_control_idx,
            "default_command": np.zeros(len(self.base_control_idx)),
            "use_impedances": False,
        }

    @property
    def _default_controller_config(self):
        # Always run super method first
        cfg = super()._default_controller_config

        # Add supported base controllers
        cfg["base"] = {
            self._default_base_joint_controller_config["name"]: self._default_base_joint_controller_config,
            self._default_base_null_joint_controller_config["name"]: self._default_base_null_joint_controller_config,
        }

        return cfg

    def move_by(self, delta):
        """
        Move robot base without physics simulation

        Args:
            delta (float):float], (x,y,z) cartesian delta base position
        """
        new_pos = np.array(delta) + self.get_position()
        self.set_position(position=new_pos)

    def move_forward(self, delta=0.05):
        """
        Move robot base forward without physics simulation

        Args:
            delta (float): delta base position forward
        """
        self.move_by(quat2mat(self.get_orientation()).dot(np.array([delta, 0, 0])))

    def move_backward(self, delta=0.05):
        """
        Move robot base backward without physics simulation

        Args:
            delta (float): delta base position backward
        """
        self.move_by(quat2mat(self.get_orientation()).dot(np.array([-delta, 0, 0])))

    def move_left(self, delta=0.05):
        """
        Move robot base left without physics simulation

        Args:
            delta (float): delta base position left
        """
        self.move_by(quat2mat(self.get_orientation()).dot(np.array([0, -delta, 0])))

    def move_right(self, delta=0.05):
        """
        Move robot base right without physics simulation

        Args:
            delta (float): delta base position right
        """
        self.move_by(quat2mat(self.get_orientation()).dot(np.array([0, delta, 0])))

    def turn_left(self, delta=0.03):
        """
        Rotate robot base left without physics simulation

        Args:
            delta (float): delta angle to rotate the base left
        """
        quat = self.get_orientation()
        quat = qmult((euler2quat(-delta, 0, 0)), quat)
        self.set_orientation(quat)

    def turn_right(self, delta=0.03):
        """
        Rotate robot base right without physics simulation

        Args:
            delta (float): angle to rotate the base right
        """
        quat = self.get_orientation()
        quat = qmult((euler2quat(delta, 0, 0)), quat)
        self.set_orientation(quat)

    @property
    def base_action_idx(self):
        controller_idx = self.controller_order.index("base")
        action_start_idx = sum([self.controllers[self.controller_order[i]].command_dim for i in range(controller_idx)])
        return np.arange(action_start_idx, action_start_idx + self.controllers["base"].command_dim)

    @property
    @abstractmethod
    def base_control_idx(self):
        """
        Returns:
            n-array: Indices in low-level control vector corresponding to base joints.
        """
        raise NotImplementedError

    @classproperty
    def _do_not_register_classes(cls):
        # Don't register this class since it's an abstract template
        classes = super()._do_not_register_classes
        classes.add("LocomotionRobot")
        return classes

base_control_idx abstractmethod property

Returns:

Type Description

n-array: Indices in low-level control vector corresponding to base joints.

move_backward(delta=0.05)

Move robot base backward without physics simulation

Parameters:

Name Type Description Default
delta float

delta base position backward

 0.05
Source code in omnigibson/robots/locomotion_robot.py 
138
139
140
141
142
143
144
145
def move_backward(self, delta=0.05):
    """
    Move robot base backward without physics simulation

    Args:
        delta (float): delta base position backward
    """
    self.move_by(quat2mat(self.get_orientation()).dot(np.array([-delta, 0, 0])))

move_by(delta)

Move robot base without physics simulation

Parameters:

Name Type Description Default
delta float

float], (x,y,z) cartesian delta base position

 required
Source code in omnigibson/robots/locomotion_robot.py 
119
120
121
122
123
124
125
126
127
def move_by(self, delta):
    """
    Move robot base without physics simulation

    Args:
        delta (float):float], (x,y,z) cartesian delta base position
    """
    new_pos = np.array(delta) + self.get_position()
    self.set_position(position=new_pos)

move_forward(delta=0.05)

Move robot base forward without physics simulation

Parameters:

Name Type Description Default
delta float

delta base position forward

 0.05
Source code in omnigibson/robots/locomotion_robot.py 
129
130
131
132
133
134
135
136
def move_forward(self, delta=0.05):
    """
    Move robot base forward without physics simulation

    Args:
        delta (float): delta base position forward
    """
    self.move_by(quat2mat(self.get_orientation()).dot(np.array([delta, 0, 0])))

move_left(delta=0.05)

Move robot base left without physics simulation

Parameters:

Name Type Description Default
delta float

delta base position left

 0.05
Source code in omnigibson/robots/locomotion_robot.py 
147
148
149
150
151
152
153
154
def move_left(self, delta=0.05):
    """
    Move robot base left without physics simulation

    Args:
        delta (float): delta base position left
    """
    self.move_by(quat2mat(self.get_orientation()).dot(np.array([0, -delta, 0])))

move_right(delta=0.05)

Move robot base right without physics simulation

Parameters:

Name Type Description Default
delta float

delta base position right

 0.05
Source code in omnigibson/robots/locomotion_robot.py 
156
157
158
159
160
161
162
163
def move_right(self, delta=0.05):
    """
    Move robot base right without physics simulation

    Args:
        delta (float): delta base position right
    """
    self.move_by(quat2mat(self.get_orientation()).dot(np.array([0, delta, 0])))

turn_left(delta=0.03)

Rotate robot base left without physics simulation

Parameters:

Name Type Description Default
delta float

delta angle to rotate the base left

 0.03
Source code in omnigibson/robots/locomotion_robot.py 
165
166
167
168
169
170
171
172
173
174
def turn_left(self, delta=0.03):
    """
    Rotate robot base left without physics simulation

    Args:
        delta (float): delta angle to rotate the base left
    """
    quat = self.get_orientation()
    quat = qmult((euler2quat(-delta, 0, 0)), quat)
    self.set_orientation(quat)

turn_right(delta=0.03)

Rotate robot base right without physics simulation

Parameters:

Name Type Description Default
delta float

angle to rotate the base right

 0.03
Source code in omnigibson/robots/locomotion_robot.py 
176
177
178
179
180
181
182
183
184
185
def turn_right(self, delta=0.03):
    """
    Rotate robot base right without physics simulation

    Args:
        delta (float): angle to rotate the base right
    """
    quat = self.get_orientation()
    quat = qmult((euler2quat(delta, 0, 0)), quat)
    self.set_orientation(quat)