An example method includes receiving, from a sensor, an image of an environment, where the environment includes a robotic device. The method also includes determining, based on the received image of the environment, a pose of the robotic device relative to the sensor. The method further includes determining, based on the pose of the robotic device relative to the sensor, respective positions of a plurality of trajectory points for the robotic device relative to the sensor. The method additionally includes providing for display of the image of the environment and an overlaid plurality of virtual trajectory points corresponding to the plurality of trajectory points, where the plurality of virtual trajectory points are positioned in the image based on the determined respective positions of the plurality of trajectory points for the robotic device relative to the sensor.

A method substantially simultaneously plans a path and maps an environment by a robot. The method determines a mean of an occupancy level for a location in a map. The method also includes determining a probability distribution function (PDF) of the occupancy level. The method further includes calculating a cost function based on the PDF. Finally, the method includes simultaneously planning the path and mapping the environment based on the cost function.

Example systems and methods may be used to determine a trajectory for moving an object using a robotic device. One example method includes determining a plurality of possible trajectories for moving an object with an end effector of a robotic manipulator based on a plurality of possible object measurements. The method may further include causing the robotic manipulator to pick up the object with the end effector. After causing the robotic manipulator to pick up the object with the end effector, the method may also include receiving sensor data from one or more sensors indicative of one or more measurements of the object. Based on the received sensor data, the method may additionally include selecting a trajectory for moving the object from the plurality of possible trajectories. The method may further include causing the robotic manipulator to move the object through the selected trajectory.

A robot motion data processing system has a data extraction module for intermittently extracting restoration motion data from a successive input motion trajectory formed for controlling a motion of a robot, and a data restoration module for restoring an output motion trajectory approximate to the input motion trajectory by using restoration motion data extracted from the data extraction module. The output motion trajectory is restored to satisfy a condition that the robot operating according to the output motion trajectory does not exceed a hardware operation limit of the robot.

An apparatus and method for providing robot work data adaptive to changes in a work environment. The apparatus may include a robot work data provider, a robot work data processor, and a robot motion data provider. The apparatus and method define a robot's work using an obtained work path and obtained environmental information, and provide robot motion data to control robot motions to actively adapt to changes in its work environment.

Collision detection useful in motion planning for robotics advantageously represents planned motions of each of a plurality of robots as obstacles when performing motion planning for any given robot in the plurality of robots that operate in a shared workspace, including taking into account the planned motions during collision assessment. Edges of a motion planning graph are assigned cost values, based at least in part on the collision assessment. Obstacles may be pruned as corresponding motions are completed. Motion planning requests may be queued, and some robots skipped, for example in response to an error or blocked condition.

The invention includes systems and methods for determining movement of a robot. A computing system of the robot receives information comprising a reference behavior specification, a current state of the robot, and a characteristic of a massive body coupled to or expected to be coupled to the robot. The computing system determines, based on the information, a set of movement parameters for the robot, the set of movement parameters reflecting a goal trajectory for the robot. The computing system instructs the robot to move consistent with the set of movement parameters.

The invention includes systems and methods for determining movement of a robot. A computing system of the robot receives information comprising a reference behavior specification, a current state of the robot, and a characteristic of a massive body coupled to or expected to be coupled to the robot. The computing system determines, based on the information, a set of movement parameters for the robot, the set of movement parameters reflecting a goal trajectory for the robot. The computing system instructs the robot to move consistent with the set of movement parameters.