Patent Description:
With development of the robot technology, the robotic apparatuses are increasingly widely used in various fields, for example, the medical field. Traditional medical robotic apparatus may manipulate an executing instrument, such as a surgical instrument, with a robotic arm adopting a parallel mechanism (PLM), such that the surgical instrument is moved and constrained at a fixed remote center of motion (RCM). Moreover, a plurality of encoders (ENC) installed at the parallel mechanism are used to measure the angle synchronization between insertion arm (ISA) for holding the surgical instrument and the compact motor drive (CMD) for driving the parallel mechanism. However, the encoder system can only achieve measurement of pitch angle synchronization between the compact motor drive and the insertion arm, but cannot measure the displacement of the parallel mechanism in other directions. Moreover, the encoder system may result in increased number of circuit module devices in the parallel mechanism, which reduces the reliability of the robotic apparatus and increases wiring complexity, and thus increases the complexity of structural design and affects the structural optimization design of the robotic apparatus.

<NPL> discloses a fully-integrated end-effector positioning system for large-scale multi-robotic setups used for non-repetitive manufacturing tasks.

Embodiments of the present disclosure provide robotic apparatus and a control method thereof, and a system and a computer storage medium, in order to at least address one of the above-mentioned problems that deformation in other directions of the parallel mechanism cannot be measured, the structure is complex, and reliability of the robotic apparatus is low.

The robotic apparatus and control method thereof according to embodiments of the present disclosure use at least one inertial sensor to detect inertial sensing data and perform data fusion and analysis. In this way, precision of the detection performed on the robotic apparatus can be improved, thereby improving the reliability of the robotic apparatus. Moreover, a plurality of sets of encoders can be eliminated, thereby greatly simplifying the structure of the robotic apparatus, reducing weight and volume of the robotic apparatus, and reducing costs.

By providing more detailed description of the embodiments of the present disclosure with reference to the accompanying drawings, the above and other purposes, features, and advantages of the present disclosure will become more apparent. The accompanying drawings are used to provide a further understanding of the embodiments of the present disclosure and form a part of the specification. The accompanying drawings, together with the embodiments of the present disclosure, are used to illustrate the present disclosure and do not constitute a limitation of the present disclosure. In the accompanying drawings, the same reference numerals usually represent the same components or operations.

In order to make the purpose, technical solution, and advantages of the present disclosure more apparent, the following will refer to the accompanying drawings to describe in detail the exemplary embodiments according to the present disclosure. Obviously, the described embodiments are only a portion of the embodiments of the present disclosure, not all of them. It should be understood that the present disclosure is not limited by the exemplary embodiments described herein. Based on the embodiments described in the present disclosure, all other embodiments obtained by those skilled in the art without creative works shall fall within the scope of protection of the present disclosure.

Traditional robotic apparatus used in the medical field, such as surgical robots, has a parallel mechanism including one or more pre-tensioned metal strips or steel belts (PSB) for transmitting driving force, and uses a plurality of encoder modules installed at the parallel mechanism to measure the angle synchronization between the insertion arm for a surgical instrument and the compact motor drive, as well as the elongation of the metal strips and the displacements of the parallel mechanism, thereby implementing safety detection of a structural state. However, the encoder modules are unable to measure the displacements of the parallel mechanism in other directions and proactively detect collisions occurred on the robotic arm from external environment. Moreover, using encoder modules will result in increased number of module devices in the parallel mechanism, reduced reliability of the robotic apparatus and increased wiring complexity, thereby increasing the complexity of structural design and affecting structural optimization design.

Referring to <FIG> shows a schematic diagram of the robotic apparatus. As shown in <FIG>, a traditional surgical robot employs a remote center of motion <NUM> for each robotic arm to operate on a target object through a respective one of several small holes and improve the safety of the surgery. The yawing and pitching movements of the surgical instrument (SGI) <NUM> disposed at the front end of the robotic apparatus are achieved by the driving force provided by the compact motor drives <NUM> and <NUM> disposed at the rear end of the robot. For example, the compact motor drives <NUM> and <NUM> transmit the driving force to the insertion arm <NUM> for the surgical instrument through the parallel mechanism <NUM> and pre-tensioned metal strips installed inside the parallel mechanism <NUM>. Moreover, the insertion arm <NUM> for the surgical instrument provides the translational motion of the surgical instrument <NUM> along a central axis, thereby achieving control of the surgical instrument of multiple degree of freedom.

The reliability of transmission of driving force of the robotic apparatus as shown in <FIG> depends on the structural integrity of the parallel mechanism <NUM> and the pre-tensioning force of the pre-tensioned metal strips. Traditional robotic apparatus uses a plurality of encoder modules <NUM>, <NUM>, <NUM> installed in the parallel mechanism <NUM> to measure the changes in relationship between output angles and input angles of each link of the parallel mechanism <NUM> in real-time, in order to determine the integrity of the parallel mechanism <NUM> and the pre-tensioning degree of the pre-tensioned metal strips. Referring to <FIG> shows a schematic flowchart of synchronization detection of pitch angles for the robotic apparatus. As shown in <FIG>, the pitch angles output by compact motor drives <NUM> and <NUM> are output to the insertion arm <NUM> for surgical instrument through the parallel mechanism <NUM> and the pre-tensioned metal strips installed inside the parallel mechanism <NUM>. The encoder modules <NUM>, <NUM>, <NUM> provide feedback on the actual pitch angles of PLM and ISA. After processing the actual pitch angles and the pitch angles output by the compact motor drives <NUM> and <NUM>, the system state machine makes a judgment on whether an error in synchronization of pitch angles occurs or the pre-tensioned metal strips in the parallel mechanism <NUM> fracture. Based on this, the controller may interrupt the surgery and issue an alarm prompt for maintenance of the robotic apparatus.

It can be seen that as shown in <FIG>, the coordination of the plurality of encoder modules <NUM>, <NUM>, <NUM> installed in the parallel mechanism <NUM> will increase the circuit design requirements, installation of sensors, and mechanical coordination of the safety detection system in the parallel mechanism. Thus, the entire system has a complex design, reduced reliability, reduced design degree of freedom of the parallel mechanism, and increased weight of the product. Moreover, the system of encoder modules cannot detect synchronization abnormalities of yawing angles.

In view of the above, a robotic apparatus and a control method thereof according to embodiments of the present disclosure are proposed. Referring to <FIG> shows a schematic diagram of the robotic apparatus according to some embodiments of the present disclosure. As shown in <FIG>, the robotic apparatus <NUM> may include:.

In some embodiments, the executing instrument <NUM> may be a surgical instrument. In some embodiments, a surgical instrument may be an instrument that performs surgical operations (such as grasping, shearing, cutting, clamping, sewing, etc.) on a target object, such as surgical forceps, surgical scissors, high-frequency electric knives, suture needles or the like. In some embodiments, the surgical instrument may also be an instrument that assist in performing surgical operations, such as various types of image acquisition devices, endoscopes or the like. It should be understood that the surgical instruments are not limited to the above-listed examples, but may be any instruments related to performing surgery, and will not be exhaustively described herein.

In some embodiments, the executing device <NUM> may include a motor pack (MPK) for a surgical instrument and configured to drive the surgical instrument fixed on the executing device to perform various surgical operations.

In some embodiments, the driving device <NUM> may include an insertion arm for the surgical instrument.

In some embodiments, the inertial sensor <NUM> includes two or more of a gyroscope, an accelerometer, and a magnetometer. In some embodiments, two types of the inertial sensor <NUM> may be employed, for example: a gyroscope and an accelerometer, a gyroscope and a magnetometer. Alternatively, more than two types of the inertial sensor <NUM> may be employed, for example: a gyroscope, an accelerometer, and a magnetometer.

In some embodiments, the control device <NUM> may be implemented by software, hardware, firmware, or a combination thereof. In some embodiments, the control device <NUM> may use circuits, which may include one or more of an application specific integrated circuit (ASIC), a digital signal processor (DSP), a digital signal processing device (DSPD), a programmable logic device (PLD), a field programmable gate array (FPGA), a central processing unit (CPU), a PLC, a microcontroller, and a microprocessor.

In some embodiments, the robotic apparatus further includes:.

In some embodiments, the transmission device <NUM> may include a parallel mechanism.

In some embodiments, the force providing device <NUM> may include one or more motors, for example, a compact motor drive. In some embodiments, the control device <NUM> may control the output angles of the force providing device <NUM>.

In some embodiments, the adjusting device <NUM> may include a set-up joint (SUJ) disposed at a rear end of the robotic apparatus. As shown in <FIG>, the robotic apparatus may be a surgical robot, and the transmission device <NUM> together with the force providing device <NUM> may serve as a robotic arm of the surgical robot. The set-up joint is disposed at the rear end of the robotic arm and connected to the robotic arm. The set-up joint can conduct one or more of operations of moving the robotic arm horizontally, moving the robotic arm vertically, and adjusting the orientation of the robotic arm, in order to adjust the robotic arm to be in the suitable orientation and position, thereby ensuring that the area of the target object on which surgical operations are performed is within the range of motion of the executing device <NUM>, so that the distance between the robotic arm and the target object is suitable for surgical operations on the target object. Referring to <FIG> shows a schematic flowchart of the method for controlling the robotic apparatus according to some embodiments of the present disclosure. As shown in <FIG>, the method may be performed by the robotic apparatus, and the method <NUM> for controlling the robotic apparatus includes:.

By using at least one inertial sensor disposed on one or both of the executing device and the driving device to acquire inertial sensing data and performing data fusion and analysis, precision of the detection performed on the robotic apparatus can be improved, the operation status of the robotic apparatus can be accurately analyzed, and corresponding control can be conducted. In this way, the reliability of the robotic apparatus can be improved. Compared with the traditional robotic apparatus, a plurality of sets of encoders can be eliminated, thereby greatly simplifying the structure of the robotic apparatus, reducing weight and volume of the robotic apparatus, and reducing costs.

In some embodiments, the inertial sensing data includes one or more of acceleration data, angular velocity data, and earth magnetic field direction data. In some embodiments, the acceleration data may be collected through detection by an accelerometer. In some embodiments, the angular velocity data may be collected through detection by a gyroscope. In some embodiments, the earth magnetic field direction data is collected through detection by a magnetometer. In some embodiments, the accelerometer, the gyroscope, or the magnetometer each sends collected respective inertial sensing data to the control device, and the control device performs data fusion calculations to obtain the fused data.

In some other embodiments, a complementary algorithm, an algorithm based on noise models, or an algorithm based on particle swarm optimization is used to perform the data fusion on at least the inertial sensing data.

The algorithms for the data fusion are used to fuse data based on optimized utilization of the inertial sensing data and control signals, including but not limited to inertial sensing data (such as acceleration data, angular velocity data, or direction data), output of the driving devices (such as torque output of a driver), input current of the force providing device (such as motor detection current), etc., to generate optimized deformation amount signals of the transmission device. In comparison, the complementary algorithm has the lowest computation complexity and average fusion performance. The algorithm based on noise models has slightly higher computation complexity and excellent fusion performance. The algorithm based on particle swarm optimization has the highest computation complexity and the best data fusion performance.

In some other embodiments, the operation S420 of performing the data fusion on at least the inertial sensing data, includes:
calculating one or more of an actual pitching angle, an actual rolling angle and an actual yawing angle of the driving device based on at least the inertial sensing data.

The operation S430 of determining the operation status of the robotic apparatus based on the fused data, and controlling the robotic apparatus in response to the operation status, includes:.

By determining whether one or more of the actual pitching angle, the actual rolling angle and the actual yawing angle of the driving device are synchronized with a respective target angle, it can be determined whether the robotic apparatus is working abnormally. For example, referring to <FIG>, in a surgical robot, the executing instrument <NUM> may be a surgical instrument, the executing device <NUM> may include a motor pack for a surgical instrument, the driving device <NUM> may include an insertion arm for surgical instrument, and the motor pack for the surgical instrument may be disposed on the track of the insertion arm for surgical instrument. The insertion arm for surgical instrument drives the motor pack for the surgical instrument on which the surgical instrument is mounted to move on the track to perform corresponding surgical operations. It can be seen that the executing device <NUM> and the driving device <NUM> are consistent in pitching angle, rolling angle, or yawing angle. Thus, either the executing device <NUM> or the driving device <NUM> may be provided with at least one inertial sensor, and the fused data may be obtained by fusing the data collected through detection by the at least one inertial sensor. Alternatively, the executing device <NUM> and the driving device <NUM> are each provided with at least one inertial sensor for concurrent detection. In this way, redundancy of the inertial sensors can be achieved, resulting in redundancy of inertial sensing data, thereby ensuring data accuracy and improving the accuracy of the subsequent data fusion.

In some embodiments, when there are a plurality of inertial sensors of each type, the average value or median of the inertial sensor data obtained through the inertial sensors of a same type may be used for the data fusion. For example, for the angular velocity data of the driving device, the average value or median of the angular velocity data of the driving device obtained through the inertial sensors of a same type may be used as the angular velocity data of the driving device for the data fusion. Data obtained through the inertial sensors of other types may be processed similarly.

In some embodiments, working abnormality includes: one or more of the pitching angle, the rolling angle, and the yawing angle are out of synchronization. In some embodiments, the working abnormality may also include: the parallel mechanism including one or more fractured pre-tensioned metal strips or steel belts.

In some embodiments, the method may further include: when it is determined that the robot apparatus is working abnormally, issuing an alarm. In some embodiments, the robotic apparatus may be stopped from working after issuing the alarm. It can be seen that the alarm issued when the robotic apparatus is working abnormally can facilitate users to stop and repair timely.

In some embodiments, the alarm may be in sound and light mode, or may be display, on a display device of the robotic apparatus, of contents indicating non-synchronization of one or more of the pitching angle, rolling angle, and yawing angle, and/or fracture of the metal strips or steel belts in the transmission device.

In some embodiments, determining whether one or more of the actual pitching angle, the actual rolling angle and the actual yawing angle are synchronized with the one or more respective target angles, includes:.

In some embodiments, the preset angle range may be a range centered at the target angle. For example, when the target angle is At, the preset angle range may be [At-a, At +b], where a and b may be the same or different, and a and b are positive numbers. It should be understood that each of the pitching angle, the rolling angle, and the yawing angle has a respective target angle.

The values of a and b may be set as needed and are not limited in the present disclosure. For example, the values of a and b may be set considering the transitional bumps caused by the structural flexibility of the transmission device.

In some embodiments, the target angle may be the angle output by the force providing device, for example, one or more of the pitching angle, the rolling angle, and the yawing angle output by the compact motor drive.

In some embodiments, the operation S430 of determining the operation status of the robotic apparatus based on the fused data, further includes:
in response to the actual pitching angle, the actual rolling angle and the actual yawing angle each falling within the respective preset angle range, determining that each of the actual pitching angle, the actual rolling angle and the actual yawing angle is synchronized with a respective target angle.

In some embodiments, the operation S430 of determining the operation status of the robotic apparatus based on the fused data, further includes:
in response to one or more of the actual pitching angle, the actual rolling angle and the actual yawing angle not falling within the respective preset angle range, determining that the actual pitching angle, the actual rolling angle or the actual yawing angle is not synchronized with the one or more respective target angles.

In some embodiments, when each of the actual pitching angle, the actual rolling angle and the actual yawing angle is synchronized with a respective target angle, it is determined that the robotic apparatus is working normally.

In some embodiments, the operation S430 of determining the operation status of the robotic apparatus based on the fused data, and controlling the robotic apparatus in response to the operation status, further includes:.

The one or more respective synchronization rates for one or more of the actual pitching angle, the actual rolling angle and the actual yawing angle of the driving device or the one or more respective changes in the one or more respective synchronization rates may be used to determine whether the robotic apparatus is working normally. In response to the one or more respective synchronization rates for one or more of the actual pitching angle, the actual rolling angle and the actual yawing angle being less than one or more respective synchronization rate thresholds, or in response to the one or more respective changes in the one or more respective synchronization rates for one or more of the actual pitching angle, the actual rolling angle and the actual yawing angle being excessive (being greater than the one or more respective change thresholds), it is determined that the robotic apparatus is working abnormally, and the robotic apparatus may be controlled to stop working, in order to prevent the robotic apparatus from being damaged.

It can be seen that in the method for controlling the robotic apparatus according to the embodiments of the present disclosure, the rolling angles, the pitching angles, and the yawing angles of the transmission device (such as a parallel mechanism) and the driving device (such as an insertion arm for surgical instrument) are detected concurrently, thereby achieving multi-directional movement detection of the robotic apparatus and increasing the comprehensiveness of angle synchronization monitoring safety system for the surgical robot.

The operation S420 of performing the data fusion on at least the inertial sensing data to obtain the fused data of the robotic apparatus, includes:.

By fusing the control signals of the robotic apparatus with the inertial sensing data detected by the inertial sensor, the obtained fused data contains more comprehensive and accurate information. The state analysis of the robotic apparatus is performed based on the more comprehensive and accurate fused data, in this way, accuracy of the state analysis of the robotic apparatus can be improved, thereby facilitating accurate control of the robotic apparatus.

The control signal includes one or more of: an output signal of the force providing device, such as output angle, output current, output torque or the like; an input signal of the transmission device; and an output signal of the driving device, such as driving torque output or the like.

In some embodiments, the robotic apparatus further includes a transmission device connected to the driving device and configured to move the driving device.

The operation S430 of determining the operation status of the robotic apparatus based on the fused data, includes:
determining, based on the permanent consumption, whether the robotic apparatus is working normally, and determining remaining usage time or a remaining usage number of times of the transmission device.

Before the operation of calculating, each time, a respective difference between the output angle of the transmission device and the input angle of the transmission device, the method may further include: acquiring the input angle of the transmission device.

The input angle of the transmission device is the output angle of the power device, and the power device can be controlled by the control device. That is, the control device sends corresponding control commands to the power device to control the output angle of the power device, and the output angle of the power device (i.e. the input angle of the transmission device) can be used as the control signal.

In some embodiments, the operation of determining, based on the permanent consumption, whether the robotic apparatus is working normally, and determining remaining usage time or a remaining usage number of times of the transmission device, includes:
when the permanent consumption exceeds a preset consumption, determining that the robotic apparatus is working abnormally, and the remaining usage time of the transmission device is <NUM>.

In some embodiments, when it is determined that the robotic apparatus is working abnormally, the robotic apparatus is controlled to stop working.

In some embodiments, the operation of determining, based on the permanent consumption, whether the robotic apparatus is working normally, and determining remaining usage time or a remaining usage number of times of the transmission device, includes:
when the permanent consumption does not exceed the preset consumption, determining that the robotic apparatus is working normally, and the remaining usage time or the remaining usage number of times of the transmission device is obtained by dividing the difference between the permanent consumption and the preset consumption by an average consumption.

In some embodiments, the average consumption may be calculated based on the permanent consumption and the usage time or the usage number of times corresponding to the permanent consumption. For example, average consumption may be obtained by dividing permanent consumption by corresponding usage time, or average consumption may be obtained by dividing permanent consumption by corresponding usage number of times.

In some embodiments, the preset consumption may be the consumption corresponding to the time point at which pre-tensioning or replacement is required. When the preset consumption indicates the time point at which pre-tensioning is required, the calculated remaining usage time or remaining usage number of times of the transmission device indicates the remaining usage time or remaining usage number of times before the next pre-tensioning of the transmission device. When the preset consumption indicates the time point at which replacement is required, the calculated remaining usage time or remaining usage number of times of the transmission device indicates the remaining usage time or remaining usage number of times before replacement of the transmission device. It should be understood that the preset consumption may be set as needed, and is not limited in the present disclosure.

In some embodiments, the input angle of the transmission device may be the output angle of the force providing device, for example, the pitching angle, rolling angle, and yawing angle output by the compact motor drive.

The transmission device may be a parallel mechanism, and a mathematical kinematic model for the transmission device may be the mathematical kinematic model for the parallel mechanism. The permanent consumption of the transmission device may be estimated based on the mathematical kinematic model for the transmission device and one or both of a change and a rate of change in neighboring differences between the respective inputs and the respective outputs of the transmission device, in order to obtain the remaining usage time of the transmission device. The permanent consumption may refer to the unrecoverable consumption in the transmission device. Taking a transmission strip in the transmission device as an example, the permanent consumption refers to the unrecoverable elongation of the transmission strip, and the remaining usage number of times or the remaining usage time of the transmission strip may be estimated based on the elongation of the transmission strip in each use of the transmission device.

In some embodiments, the method <NUM> for controlling the robotic apparatus may further include:
reporting, by an output device of the robotic apparatus, one or more of the permanent consumption, remaining usage time, and remaining usage number of times of the transmission device.

In some embodiments, the method <NUM> for controlling the robotic apparatus may further include:
determining the time point at which maintenance of the transmission device is required based on one or both of the remaining usage time and the remaining usage number of times of the transmission device.

In some embodiments, the method <NUM> for controlling the robotic apparatus may further include:
reporting, by the output device of the robotic apparatus, a maintenance duration for the transmission device.

It can be seen that by estimating one or more of the permanent consumption, the remaining usage time, and the remaining usage number of times of the transmission device, maintenance work can be reasonably arranged, thereby reducing maintenance times and costs, and improving maintenance efficiency.

In some embodiments, the inertial sensing data includes acceleration data.

The operation S420 of performing the data fusion on at least the inertial sensing data, includes:.

In some embodiments, the operation of determining whether a collision occurs on the robotic apparatus based on the theoretical acceleration data and the acceleration data, may include:.

The force providing device may be disposed at a joint of the robotic arm of the surgical robot, and the transmission device may be the robotic arm. The acceleration data collected through detection by the inertial sensor may be compared with the theoretical acceleration output by the transmission device. When a collision occurs, the force providing device connected to the transmission device increases its input current to maintain the moving speed. Thus, the theoretical acceleration data obtained based on the detected input current and the mathematical kinematic model for the transmission device will increase, while the actual acceleration data detected by the inertial sensor will decrease due to the collision. Therefore, when the collision occurs, the theoretical acceleration data will be greater than the detected acceleration data. Based on this, it is possible to actively detect whether there is a collision between the transmission device (for example a robotic arm) and surrounding objects, the collision mainly includes a collision between robotic arms and a collision between the robotic arm and external environment. In this way, the safety of the robotic apparatus can be improved.

In some embodiments, the method <NUM> may further include: prompting the user when a collision is detected. For example, a specific sound or voice prompt may be issued, or an occurred collision may be indicated using the output device of the robotic apparatus, for example, a prompt message may be displayed on the display device of the robotic apparatus.

In some embodiments, the method <NUM> may further include: stopping the robotic arm on which the collision occurs after detecting the collision. In this way, it is convenient for users to remove obstacles.

In some embodiments, the operation S420 of performing the data fusion on at least the inertial sensing data, includes:.

The operation S430 of determining the operation status of the robotic apparatus based on the fused data, and controlling the robotic apparatus in response to the operation status, includes:
controlling at least one angle of the adjusting device based on the magnitude and the direction of the force.

Referring to <FIG>, after the surgical instrument is installed on the robotic apparatus, the transmission device <NUM> (such as a parallel mechanism) and the force providing device <NUM> (such as a compact motor drive) will be in an angle-maintaining state. When a user (such as a medical staff) manually moves the executing device <NUM> (such as an insertion arm for surgical instrument) thereby causing deformation of the transmission device <NUM> (such as a parallel mechanism), the deformation degree of the transmission device <NUM> (such as a parallel mechanism) detected in real-time by the at least one inertial sensor <NUM> may be used to estimate the magnitude and direction of the force applied by the user. The control device then acquires the torque and speed output required by each joint of the adjusting device <NUM> (such as the set-up joint) disposed at the rear end of the robotic apparatus using the inverse kinematics algorithm, and sends corresponding commands to the set-up joint to achieve the angle control of the set-up joint, so that the user can easily move the set-up joint.

Referring to <FIG> shows an example of the method for controlling the robotic apparatus according to some embodiments of the present disclosure. As shown in <FIG>, the control method <NUM> for the robotic apparatus includes the following operations.

At S510, the pitch angle and yawing angle output by the force providing device (such as the compact motor drive) are transmitted to the driving device (such as the insertion arm for surgical instrument) by the transmission device (such as the parallel mechanism) and the pre-tensioned metal strips installed inside the transmission device.

At S520, acceleration data, angular velocity data, and direction data of the driving device are generated with detection by the at least one inertial sensor (also known as inertial measurement unit, IMU) disposed on the driving device to obtain the actual pitching angle, actual rolling angle, and actual yawing angle of the driving device.

At S530, data fusion is performed on the data detected by the sensor and the control signal using data fusion algorithms, and the operation status of the robotic apparatus is analyzed.

At S541, it is determined whether one or more of the actual pitching angle, the actual rolling angle, and the actual yawing angle are synchronized with the one or more respective target angles; and when one or more of the actual pitching angle, the actual rolling angle, and the actual yawing angle are out of synchronization, it is determined that the robotic apparatus is working abnormally and an alarm is triggered.

At S542, the robotic apparatus is stopped for maintenance.

At S551, the permanent consumption and/or the remaining usage time of the transmission device is estimated based on the mathematical model for the transmission device and a difference between the input and the output of the transmission device; and a time point at which maintenance of the transmission device is required is determined according to the permanent consumption and/or the remaining usage time of the transmission device.

At S552, the time point at which maintenance of the transmission device is required is reported using the output device of the robotic apparatus.

At S561, the magnitude and the direction of the force applied by the user is estimated based on the deformation degree of the transmission device (such as a parallel mechanism) calculated based on the inertial sensing data detected by the at least one inertial sensor in real time.

At S562, corresponding commands are sent to the set-up joint based on the magnitude and the direction of the force to achieve angle control of the set-up joint.

At S571, it is determined whether a collision with surrounding objects occurs on the transmission device based on the fused data and the acceleration data.

At S572, when detecting the collision, the robotic arm on which the collision occurs is stopped for medical staff to remove obstacles.

Those skilled in the art can realize that the units and algorithm operations in each example described in the disclosed embodiments herein may be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are implemented in hardware or software depends on the specific application and design constraints of the technical solutions. Those skilled in the art may use different methods to achieve the described functions for each specific application, but such implementation should not be considered beyond the scope of the present disclosure.

In the embodiments provided the present disclosure, it should be understood that the disclosed apparatus and methods may be implemented in other ways. For example, the apparatus embodiments described above are only exemplary. For example, the division of the units is only a logical functional division, and there may be other division methods in actual implementation. For example, a plurality of units or components may be combined or integrated into another device, or some features may be omitted or not executed.

Claim 1:
A method for controlling a robotic apparatus, wherein the robotic apparatus comprises: an executing device on which an executing instrument is mounted, a driving device configured to drive the executing device to move on the driving device, a transmission device connected to the driving device and configured to move the driving device, and a force providing device connected to the transmission device and configured to provide a driving force to the transmission device;
wherein the method comprises:
acquiring (S410) inertial sensing data from at least one inertial sensor disposed on one or both of the executing device and the driving device;
performing (S420) data fusion on the inertial sensing data and a control signal of the robotic apparatus to obtain fused data of the robotic apparatus, including:
acquiring the control signal; and
fusing the inertial sensing data and the control signal to obtain the fused data;
and
determining (S430) an operation status of the robotic apparatus based on the fused data, and controlling the robotic apparatus in response to the operation status;
wherein the control signal includes one or more of:
an output signal of the force providing device;
an input signal of the transmission device; and
an output signal of the driving device.