US 12,076,865 B2
Method, computer program product and robot control system for the contact-based localization of objects that can be moved when manipulated by robot, and robot
Bernd Kast, Ichenhausen (DE); Philipp Sebastian Schmitt, Munich (DE); and Florian Wirnshofer, Munich (DE)
Assigned to Siemens Aktiengesellschaft, Munich (DE)
Appl. No. 17/610,168
Filed by Siemens Aktiengesellschaft, Munich (DE)
PCT Filed May 11, 2020, PCT No. PCT/EP2020/063067
§ 371(c)(1), (2) Date Nov. 10, 2021,
PCT Pub. No. WO2020/234027, PCT Pub. Date Nov. 26, 2020.
Claims priority of application No. 19175195 (EP), filed on May 17, 2019; and application No. 19178454 (EP), filed on Jun. 5, 2019.
Prior Publication US 2022/0226991 A1, Jul. 21, 2022
Int. Cl. B25J 9/16 (2006.01); B25J 13/08 (2006.01); G05B 19/4155 (2006.01)
CPC B25J 9/1633 (2013.01) [B25J 13/088 (2013.01); G05B 19/4155 (2013.01); G05B 2219/50391 (2013.01)] 14 Claims
OG exemplary drawing
 
1. A method for a contact-based localization of objects that can be moved when manipulated by a robot, wherein for a state associated with the object localization of a system formed by at least one manipulated-variable-controlled robot, an object that is movable for the robot during the object manipulation and a robot-object environment that enables the object manipulation as system components, and in the course of a system state estimation, the method comprises:
determining, by an iterative-recursive application of a Bayes filter algorithm, a probability distribution that localizes the object, wherein said determining by the iterative-recursive application of the algorithm obtains: (i) state transition probabilities, in a nondeterministic motion model for system simulation, from modeled transitions of states of the system, and fil) measurement probabilities, in a measurement model for system simulation, wherein an initial probability distribution is used at the start;
using an approximation algorithm in the iterative-recursive determination of the probability distribution;
controlling, by a controller execution of a physics simulator with a simulation system state being fed back and, on the basis of a manipulated variable fed to the controller, wherein the controller controls the physics simulator in such a way that during the system state simulation the robot behaves compliantly with respect to the robot-object environment, wherein the physics simulator is configured to use the physics of the system in regard to forces and dynamics and the resultant physical relationships of the system components;
performing model axis-specific measurements, on the robot, wherein measurement results of the axis-specific measurements are axial position, axial velocity, axial acceleration and/or axial torque of a robot ROB, wherein the robot ROB is configured to be manipulated to move the object.