Method for computer-aided movement planning of a robot
A method for computer-aided movement planning of a robot is provided, in which a trajectory for the movement of a spatial point assigned to the robot is planned in a fixed coordinates system. The spatial positions are translated from a plurality of spatial positions of the spatial point into respective configuration positions in a configuration room of the robot based on inverse kinematics. The respective configuration positions are described by axial positions of one or several rotatory or translational movement axes of the robot and are tested for collisions and a trajectory is formed along spatial positions of the spatial point, the respective configuration positions of which are collision-free. Planning the movement in a fixed coordinates system improves the efficiency of the planning method and the planned movement corresponds more to the expectations of the persons or the operating staff in the surroundings of the robot.
1. A method for planning a movement of a robot in a fixed coordinate system of a spatial point assigned to the robot, comprising:
calculating a geometry of the robot from a plurality of predetermined spatial positions of the spatial point based on a forward kinematics using a computing processor;
translating the plurality of predetermined spatial positions of the spatial point into respective configuration positions in a configuration room of the robot using a translating processor based on an inverse kinematics, wherein each respective configuration position is described by at least one rotary and/or translational movement axis of the robot;
checking the geometry of the robot with the respective configuration positions for a collision using a testing processor; and
calculating a trajectory along the predetermined spatial positions based on a result of the checking using the computing processor so that the respective configuration positions of the trajectory are collision-free.
2. The method as claimed in claim 1 , wherein the spatial point is a tool center point of the robot.
3. The method as claimed in claim 2 , wherein the fixed coordinates system is a Cartesian coordinates system.
4. The method as claimed in claim 3 , wherein the movement is a three-dimensional movement.
5. The method as claimed in claim 1 , wherein the trajectory is formed by a straight trajectory elements between different spatial positions of the spatial point.
6. The method as claimed in claim 1 , wherein upon said translating a given spatial position of the spatial point into a plurality of configuration positions, said method further comprises selecting one of the plurality of respective configuration positions according to a predetermined criteria.
7. The method as claimed in claim 6 , wherein the selected respective configuration position is selected because it has a lowest distance from a respective configuration position of a spatial point previously lying on the trajectory.
8. The method as claimed in claim 1 , wherein the method comprises selecting the plurality of spatial positions using a probabilistic planning method, a control-based planning method, and/or a potential field planning method.
9. The method as claimed in claim 1 , wherein the robot moves a robotic medical device.
10. The method as claimed in claim 9 , wherein the robotic medical device is a robot-controlled C-arm and the spatial point is an isocenter of the C-arm.
11. The method as claimed in claim 1 , wherein the movement is computer-aided.
12. A device for planning a movement of a robot in a fixed coordinate system of a spatial point assigned to the robot, comprising:
a computing processor that calculates a geometry of the robot from a plurality of predetermined spatial positions of the spatial point based on a forward kinematics using a computing processor;
a translating processor that translates a plurality of predetermined spatial positions of the spatial point into respective configuration positions in a configuration room of the robot based on an inverse kinematics, each respective configuration position being described by a movement axis of the robot; and
a testing processor that tests the geometry of the robot with the respective configuration positions for a collision,
wherein the computing processor calculates a trajectory along the predetermined spatial positions of the spatial point based on a result of the test so that the respective configuration positions of the trajectory are collision-free.
13. A robotic medical device, comprising:
a robot comprising a spatial point, wherein the spatial point moves in a trajectory; and
a processor configured to determine the trajectory that:
calculates a geometry of the robot from a plurality of predetermined spatial positions of the spatial point based on a forward kinematics using a computing processor,
translates a plurality of predetermined spatial positions of the spatial point into respective configuration positions in a configuration room of the robot based on inverse kinematics, each respective configuration position being described by a movement axis of the robot,
tests the geometry of the robot with the respective configuration positions for a collision, and
calculates the trajectory along the predetermined spatial positions of the spatial point based on a result of the test so that the respective configuration positions of the trajectory are collision-free.