A direct force feedback control method as well as a controller and a robot using the same are provided. The method includes: obtaining an actual position and an actual speed of an end of the robotic arm and an actual external force acting on the end in a Cartesian space; calculating an impedance control component of the end in the Cartesian space based on the obtained actual position, the obtained actual speed, the obtained actual external force, an expected position, an expected speed, and an expected acceleration of the end; calculating a force control component of the end in the Cartesian space based on an expected interaction force acting on the end, the actual external force, and the actual speed; determining whether the actual external force is larger than a preset threshold, and obtaining a total force control quantity of the end of the robotic arm in the Cartesian space.

Various approaches to solve for inverse kinematics may be used for teleoperation of a surgical robotic system. In one approach, an iterative solver solves for the linear component of motion independently from solving for the angular component of motion. One solver may be used to solve for both together. In another approach, all limits (e.g., position, velocity, and acceleration) are handled in one solution. Where a limit is reached, the limit is used as a bound in the intermediate solution, allowing solution even where a bound is reached. In another approach, a ratio of limits of position are used to create a slow-down region near the bounds to more naturally control motion. In yet another approach, the medical-based teleoperation uses a bounded Gauss-Siedel solver, such as with successive-over-relaxation.

The invention relates to a method of collision handling for a robot with a kinematic chain structure comprising at least one kinematic chain, wherein the kinematic chain structure includes: a base, links, joints connecting the links, actuators and at least one end-effector, a sensor S.sub.distal.i in the most distal link of at least one of the kinematic chains for measuring/estimating force/torque, and sensors S.sub.i for measuring/estimating proprioceptive data, wherein the sensors S.sub.i are arbitrarily positioned along the kinematic chain structure, the method including: providing a model describing the dynamics of the robot; measuring and/or estimating with sensor S.sub.distal.i force/torque F.sub.ext,S.distal.i in the most distal link of at least one of the kinematic chains; measuring and/or estimating with the sensors S.sub.i proprioceptive data: base and robot generalized coordinates q(t) and their time derivative {dot over (q)}(t), generalized joint motor forces τ.sub.m, external forces F.sub.S, a base orientation φ.sub.B(t) and a base velocity {dot over (x)}(t).sub.B; generating an estimate {circumflex over (τ)}.sub.∈ of the generalized external forces τ.sub.ext with a momentum observer based on at least one of the proprioceptive data and the model; generating an estimate {umlaut over ({circumflex over (q)})}(t) of a second derivative of base and robot generalized coordinates {umlaut over (q)}(t), based on {circumflex over (τ)}.sub.∈ and τ.sub.m; estimating a Cartesian acceleration {umlaut over ({circumflex over (x)})}.sub.D of point D on the kinematic chain structure based on {umlaut over ({circumflex over (q)})}(t); compensating the external forces F.sub.D for rigid body dynamics effects based on {umlaut over ({circumflex over (x)})}.sub.D and for gravity effects to obtain an estimated external wrench {circumflex over (F)}.sub.ext,S.i; compensating {circumflex over (τ)}.sub.∈ for the Jacobian J.sub.S.distal.i.sup.T transformed F.sub.ext,S.distal.i to obtain an estimation {circumflex over (τ)}.sub.ext,col of generalized joint forces originating from unexpected collisions; detecting a collision based on given thresholds τ.sub.thresh and F.sub.S.i,thresh if {circumflex over (τ)}.sub.ext,col>τ.sub.thresh and/or if {circumflex over (F)}.sub.ext,S.i>F.sub.S.i,thresh.

Systems and a method for teaching a robot in reaching a given target location. The system and method include receiving inputs on a representation of a given target location to be reached by the robot. A check is made whether the given target location is singular. If the given target location is non-singular, the teaching of the robot is effected by associating with the given target location a selected configuration. If the given target is singular, the teaching of the robot is effected by associating with the given target location an assigned joint-values solution.

A total centroid state estimation method as well as a humanoid robot and a computer readable storage medium using the same are provided. The method includes: obtaining a motion state of each real joint of the humanoid robot and a motion state of its floating base, where the floating base is equivalent to a plurality of sequent-connected virtual joints; calculating a joint position, a centroid position, and a rotation matrix of each link in the world coordinate system in sequence using the chain rule of homogeneous multiplication according to the position of the joint corresponding to the link to solve a Jacobian matrix of the centroid of the link; solving a total centroid Jacobian matrix based on the Jacobian matrix of the centroid of each link and the total mass; and calculating the total centroid velocity based on the total centroid Jacobian matrix and other parameters.

A pose control method for a robot includes: estimating a first set of joint angular velocities of all joints of the robot according to a balance control algorithm; estimating a second set of joint angular velocities of all joints of the robot according to a momentum planning algorithm; estimating a third set of joint angular velocities of all joints of the robot according to a pose return-to-zero algorithm; and performing pose control on the robot according to the first set of joint angular velocities, the second set of joint angular velocities, and the third set of joint angular velocities.

Embodiments of the present disclosure are directed towards a robotic system. The system may include a robot configured to receive an initial constrained approach for performing a robot task. The system may further include a graphical user interface in communication with the robot. The graphical user interface may be configured to allow a user to interact with the robot to determine an allowable range of robot poses associated with the robot task. The allowable range of robot poses may include fewer constraints than the initial constrained approach. The allowable range of poses may be based upon, at least in part, one or more degrees of symmetry associated with a workpiece associated with the robot task or an end effector associated with the robot. The system may also include a processor configured to communicate the allowable range of robot poses to the robot.

The present disclosure provides a robot centroid position adjustment method as well as an apparatus and a robot using the same. The method includes: obtaining initial values; obtaining a waist velocity adjustment value; calculating a current value of the centroid position; and determining whether a current value of the centroid position is equal to the planning value of the centroid position; if the current value of the centroid position is not equal to the planning value of the centroid position, obtaining the current value of the centroid position to take as the initial value of the centroid position and returning to the step of obtaining the waist velocity adjustment value until the current value of the centroid position is equal to the planning value of the centroid position. In such a manner, the balance ability of the robot can be improved.

A user interface system includes one or more controllers configured to move freely in three dimensions, where the one or more controllers include an inertial sensor coupled to measure movement of the one or more controllers, and output movement data including information about the movement. The user interface system further includes a processor coupled to receive the movement data, where the processor includes logic that, when executed by the processor, causes the user interface system to perform operations, including receiving the movement data with the processor, identifying an unintentional movement in the movement data with the processor, and outputting unintentional movement data that identifies the unintentional movement.

A coordinate calibration method of a manipulator is provided and includes steps of: (a) controlling the manipulator to move in accordance with a movement command, and acquiring the reference anchor points reached by the manipulator; (b) acquiring a rotation matrix and a translation vector according to the reference anchor points, and acquiring a reference coordinate system accordingly; (c) when the manipulator returning to the work space after temporarily leaving, controlling the manipulator to move in accordance with the movement command, and acquiring the actual anchor points reached by the manipulator; (d) acquiring a rotation matrix and a translation vector according to the actual anchor points, acquiring a corresponding actual coordinate system accordingly, and acquiring a coordinate compensation information by comparing the rotation matrixes and the translation vectors; and (e) adjusting the manipulator according to the coordinate compensation information, and maintaining the manipulator to operate in the reference coordinate system.