CN108354576A - A kind of magnetic force attitude controller - Google Patents

A kind of magnetic force attitude controller Download PDF

Info

Publication number
CN108354576A
CN108354576A CN201810002433.9A CN201810002433A CN108354576A CN 108354576 A CN108354576 A CN 108354576A CN 201810002433 A CN201810002433 A CN 201810002433A CN 108354576 A CN108354576 A CN 108354576A
Authority
CN
China
Prior art keywords
mechanical arm
control
traction mechanism
controlled object
control signal
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201810002433.9A
Other languages
Chinese (zh)
Inventor
曹烁
李彦俊
梁东
李佳坤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Chongqing Jinshan Medical Appliance Co Ltd
Original Assignee
Chongqing Jinshan Medical Appliance Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Chongqing Jinshan Medical Appliance Co Ltd filed Critical Chongqing Jinshan Medical Appliance Co Ltd
Priority to CN201810002433.9A priority Critical patent/CN108354576A/en
Publication of CN108354576A publication Critical patent/CN108354576A/en
Pending legal-status Critical Current

Links

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/04Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
    • A61B1/041Capsule endoscopes for imaging
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/00147Holding or positioning arrangements
    • A61B1/00158Holding or positioning arrangements using magnetic field
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/04Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
    • A61B1/045Control thereof
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/273Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor for the upper alimentary canal, e.g. oesophagoscopes, gastroscopes
    • A61B1/2736Gastroscopes

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Engineering & Computer Science (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Optics & Photonics (AREA)
  • Pathology (AREA)
  • Radiology & Medical Imaging (AREA)
  • Physics & Mathematics (AREA)
  • Veterinary Medicine (AREA)
  • Biomedical Technology (AREA)
  • Biophysics (AREA)
  • Medical Informatics (AREA)
  • Molecular Biology (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Gastroenterology & Hepatology (AREA)
  • Toys (AREA)

Abstract

This application discloses a kind of magnetic force attitude controllers, including:Operation console generates and sends controlled device according to control instruction and controls signal to switch board for receiving control instruction input by user;Switch board controls signal for receiving controlled device, converts control object control signal to the first analog signal and the second analog signal and be respectively sent to mechanical arm and haulage gear;Mechanical arm, for being moved using the first analog signal control controlled device;Haulage gear, for being moved using the second analog signal control controlled device;The application receives the control instruction of operation console transmission using switch board and converts digital signals into analog signal and be sent to mechanical arm and haulage gear, by superposed mechanical arm and positioned at the haulage gear of lower part, corresponding action is executed according to analog signal, the movement that allows controlled device comprehensive among mechanical arm and haulage gear and receive control, it is wider to realize detection range bigger, safety higher, control range.

Description

Magnetic force attitude controller
Technical Field
The invention relates to the field of control systems, in particular to a magnetic force attitude controller.
Background
With the continuous progress of medical science and technology and the development of industrial automation, more and more robots are applied to the medical industry, such as capsule attitude controllers; the capsule posture controller automatically pulls the stomach capsule through the permanent magnet arranged on the mechanical arm to complete the examination of the stomach.
The current attitude controller mainly has the following defects: under the condition that patient's tie was lain, unilateral magnetic force pulls and only can let the capsule drag at last stomach wall, it is rotatory, when the capsule falls to lower part stomach wall, because the magnetic force of permanent magnet is limited, be not enough to reach the distance that can pull the capsule of whereabouts to the stomach end, can not carry out effective control, and because do not have the hardware that can feed back magnet and patient distance, the host computer can't learn the position of robot apart from the human body, and attitude controller sensor is controlled by the host computer, if the host computer crashes, then the sensor is inefficacy, can consequently trigger the incident.
Therefore, how to develop a capsule attitude controller with a larger detection range, higher safety and a wider control range is a problem to be solved currently.
Disclosure of Invention
In view of the above, an object of the present invention is to provide a magnetic force attitude controller, which has a wider detection range, higher safety and a wider control range. The specific scheme is as follows:
a magnetic attitude controller comprising: the device comprises an operating platform, a control cabinet, a mechanical arm and a traction mechanism; the mechanical arm and the traction mechanism are both provided with magnets for controlling a controlled object to move, the mechanical arm and the traction mechanism are vertically arranged, and the mechanical arm is positioned above the traction mechanism;
the console is used for receiving a control instruction input by a user, generating and sending a controlled object control signal to the control cabinet according to the control instruction;
the control cabinet is used for receiving the controlled object control signal, converting the controlled object control signal into a first analog signal and a second analog signal, sending the first analog signal to the mechanical arm and sending the second analog signal to the traction mechanism;
the mechanical arm is used for controlling the controlled object to move by utilizing the first analog signal;
the traction mechanism is used for controlling the controlled object to move by utilizing the second analog signal.
Optionally, the console includes:
the mechanical arm control module is used for generating a controlled object control signal by using the control instruction, sending the controlled object control signal to the control cabinet and sending the controlled object control signal to the traction mechanism control unit;
and the traction mechanism control module is used for generating a following control signal by utilizing the controlled object control signal and sending the following control signal to the control cabinet.
Optionally, the robot arm control module includes:
and the control signal generating unit is used for generating a controlled object control signal according to the control command by utilizing an interpolation algorithm.
Optionally, the traction mechanism control module includes:
and the control signal generating unit is used for generating the following control signal according to the controlled object control signal by utilizing an electronic gear following algorithm.
Optionally, the method further includes:
the first limit sensor is connected in series with a power supply circuit of a mechanical arm in the control cabinet and is used for cutting off the power supply circuit of the mechanical arm when the pressure exceeding a threshold value on the magnet of the mechanical arm is detected;
and the second limit sensor is connected in series with a power supply circuit of the traction mechanism in the control cabinet and is used for cutting off the power supply circuit of the traction mechanism when detecting that the pressure exceeding a threshold value is applied to the magnet of the traction mechanism.
Optionally, the method further includes:
and the distance sensor is arranged on the mechanical arm and connected with the upper computer in the operating table, and is used for measuring the distance between the magnet of the mechanical arm and the human body and feeding back the distance to the upper computer.
Optionally, the distance sensor is connected to the upper computer through a digital-to-analog converter.
Optionally, the digital-to-analog converter is a single chip microcomputer including an STC15 chip, a USB serial port, an analog input terminal, and an RC filter circuit.
In the present invention, a magnetic force attitude controller includes: the device comprises an operating platform, a control cabinet, a mechanical arm and a traction mechanism; the mechanical arm and the traction mechanism are both provided with magnets for controlling a controlled object to move, the mechanical arm and the traction mechanism are vertically arranged, and the mechanical arm is positioned above the traction mechanism; the operation panel is used for receiving a control instruction input by a user, generating and sending a controlled object control signal to the control cabinet according to the control instruction; the control cabinet is used for receiving the controlled object control signal, converting the controlled object control signal into a first analog signal and a second analog signal, sending the first analog signal to the mechanical arm and sending the second analog signal to the traction mechanism; the mechanical arm is used for controlling the controlled object to move by utilizing the first analog signal; and the traction mechanism is used for controlling the controlled object to move by utilizing the second analog signal.
The invention utilizes the operation console to receive the control instruction input by the user, converts the digital signal into the analog signal through the control cabinet and sends the analog signal to the mechanical arm and the traction mechanism, the mechanical arm and the traction mechanism receive the respective analog signal and execute the corresponding action according to the analog signal to realize the azimuth control of the controlled object, and the controlled object can move and receive the control in all directions between the mechanical arm and the traction mechanism through the mechanical arm positioned at the upper part and the traction mechanism positioned at the lower part, thereby realizing larger detection range, higher safety and wider control range.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly described below, it is obvious that the drawings in the following description are only embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to the provided drawings without creative efforts.
FIG. 1 is a schematic structural diagram of a magnetic attitude controller according to an embodiment of the present invention;
fig. 2 is a schematic structural diagram of another magnetic attitude controller according to an embodiment of the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The embodiment of the invention discloses a magnetic force attitude controller, which is shown in figure 1 and comprises: an operation table 11, a control cabinet 12, a mechanical arm 13 and a traction mechanism 14; the mechanical arm 13 and the traction mechanism 14 are both provided with magnets for controlling the movement of the controlled object, the operating console 11 is electrically connected with the control cabinet 12, the control cabinet 12 is electrically connected with the mechanical arm 13 and the traction mechanism 14 respectively, and the magnets can be permanent magnets.
Specifically, the console 11 may include an upper computer, a motion control card and a control lever, the upper computer and the control lever are used for receiving a control instruction input by a user, the motion control card generates and sends a controlled object control signal to the control cabinet 12 according to the control instruction, the upper computer may further display a stomach image returned by the controlled object inside a human body through a recorder, it can be understood that the controlled object may be a capsule endoscope, a magnet is disposed on the capsule to receive control of the mechanical arm 13 and the traction mechanism 14, and the traction mechanism 14 may be installed in a hospital bed.
Specifically, since the robot arm 13 and the traction mechanism 14 are both driven by servo motors, only analog signals can be received, for this reason, the control cabinet 12 is configured to receive a controlled object control signal, through two terminal boards corresponding to the robot arm 13 and the traction mechanism 14, a first terminal board converts a digital signal corresponding to the robot arm 13 in the controlled object control signal into a first analog signal, a second terminal board converts a digital signal corresponding to the traction mechanism 14 in the controlled object control signal into a second analog signal, and the control cabinet 12 sends the first analog signal to the robot arm 13 and sends the second analog signal to the traction mechanism 14.
Specifically, the robot arm 13 includes a plurality of servo motors for controlling the movement of the controlled object by receiving the first analog signal, and the traction mechanism 14 also includes a plurality of servo motors for controlling the movement of the controlled object by using the second analog signal.
For example, the robot arm 13 and the traction mechanism 14 may each include 5 servomotors, so as to have 5 degrees of freedom each, for a total of 10 degrees of freedom, wherein the axis 1, the axis 2, and the axis 3 of the robot arm 13 may control the positioning movement of the permanent magnet mounted on the robot arm 13 in the cartesian space coordinate system, and the axis 4 and the axis 5 may control the rotation of the permanent magnet of the robot arm 13 in the yaw and pitch directions; the shaft 6, the shaft 7 and the shaft 8 of the traction mechanism 14 can control the positioning movement of the permanent magnet of the traction mechanism 14 in a Cartesian space coordinate system, and the shaft 9 and the shaft 10 can control the rotation of the permanent magnet of the traction mechanism 14 in the yaw and pitch directions.
In practical application, when the capsule is positioned at the top, the capsule is mainly dragged by a permanent magnet arranged on the mechanical arm 13, the permanent magnet of the traction mechanism 14 is used for traction, the capsule is made to shoot an image of the bottom on the stomach wall at the top by utilizing the permanent magnet of the mechanical arm 13, and the capsule is made to downwards shoot images of the stomach fundus and the side wall from various angles; when the capsule is positioned at the bottom of the stomach, the capsule is mainly dragged by a permanent magnet lifted by a traction mechanism 14, the permanent magnet of the mechanical arm 13 is used for dragging, images of the top stomach wall and the cardia pylorus are shot upwards from various angles, and the permanent magnet of the traction mechanism 14 is used for shooting the image of the upper stomach wall at the bottom of the stomach.
It can be seen that, in the embodiment of the present invention, the console 11 is used to receive a control instruction input by a user, the control cabinet 12 is used to convert a digital signal into an analog signal and send the analog signal to the robot arm 13 and the traction mechanism 14, the robot arm 13 and the traction mechanism 14 receive the respective analog signal, and perform a corresponding action according to the analog signal to implement azimuth control on a controlled object, and the robot arm 13 located at the upper portion and the traction mechanism 14 located at the lower portion enable the controlled object to move and receive control in all directions between the robot arm 13 and the traction mechanism 14, thereby implementing a larger detection range, higher security, and a wider control range.
The embodiment of the invention discloses a specific magnetic force attitude controller, and compared with the previous embodiment, the embodiment further explains and optimizes the technical scheme. Referring to fig. 2, specifically:
in an embodiment of the present invention, the console 11 may specifically include a robot arm control module 112 and a traction mechanism control module 113; wherein,
and the mechanical arm control module 112 is configured to generate a controlled object control signal by using the control instruction, send the controlled object control signal to the control cabinet 12, and send the controlled object control signal to the traction mechanism control module 113.
Further, the robot arm control module 112 may include a control signal generation unit; wherein,
and the control signal generating unit is used for generating a controlled object control signal according to the control command by utilizing an interpolation algorithm.
Specifically, the robot control module 112 calculates the movement coordinates of the robot 13 based on an interpolation algorithm after receiving the control command transmitted from the console 11, generates a controlled object control signal, and transmits the controlled object control signal to the control cabinet 12 so that the robot 13 performs a corresponding operation, and transmits the controlled object control signal to the traction mechanism 14 so that the traction mechanism 14 can operate in cooperation with the robot 13.
And the traction mechanism control module 113 is configured to generate a following control signal by using the controlled object control signal, and send the following control signal to the control cabinet 12.
Further, the traction mechanism control module 113 may include a control signal generation unit; wherein,
and the control signal generating unit is used for generating a following control signal according to the controlled object control signal by utilizing an electronic gear following algorithm.
Specifically, after receiving the controlled object control signal sent by the robot arm control module 112, the traction mechanism control module 113 may calculate the movement coordinate of the permanent magnet of the traction mechanism 14 by using an electronic gear following algorithm, generate a following control signal, and send the following control signal to the control cabinet 12, so that the traction mechanism 14 performs an action according to the second analog signal.
Different control modules are arranged for the mechanical arm 13 and the traction mechanism 14, so that the mechanical arm 13 and the traction mechanism 14 can independently operate, independent motion control programs and independent process packages are provided, and the traction mechanism 14 adopts an electronic gear following algorithm, so that the complex multi-axis interpolation algorithm can be avoided, the interpolation algorithm and the following algorithm are converted, only the electronic gear following algorithm needs to be added to the existing mechanical arm 13 interpolation algorithm, the calculation efficiency is improved, and the programming difficulty of the programs is reduced.
In practical application, since the working height of the mechanical arm 13 and the traction mechanism 14 needs to be adjusted to control the strength of the magnetic force, so as to control the posture position of the controlled object, in order to prevent the working height of the mechanical arm 13 from causing extrusion and damage to a patient and prevent the working height of the traction mechanism 14 from colliding with a hospital bed to cause equipment damage, the magnetic posture controller further comprises a first limit sensor 141 and a second limit sensor 141 which are connected in series with a power supply circuit of the control cabinet 12, and the first limit sensor 141 and the second limit sensor are used for correspondingly cutting off the power supply circuit of the mechanical arm 13 and/or the traction mechanism 14 when detecting that the magnet of the mechanical arm 13 or the magnet of the traction mechanism 14 is subjected to pressure exceeding a threshold value; the safety limit sensors are respectively arranged near the nearest positions where the mechanical arm 13 and the traction mechanism 14 are contacted with a person, so that the mechanical arm 13 and the traction mechanism 14 cannot squeeze a patient to cause injury, for example, the safety limit sensors can be arranged at the peripheries of magnets of the mechanical arm 13 and the traction mechanism 14, the first limit sensor 141 and the second limit sensor 141 can be touch sensors which are directly contacted with the patient to detect a pressure value, or can be arranged in a magnet shell and are contacted with the magnet shell to detect whether the magnet shell is squeezed or deformed to detect whether a safety limit is exceeded, when the first limit sensor 132 corresponding to the mechanical arm 13 detects that the safety limit is exceeded, a power supply circuit of the mechanical arm 13 is cut off, and when the second limit sensor 141 corresponding to the traction mechanism 14 detects that the safety limit is exceeded, the power supply circuit of the traction mechanism 14 is cut off, thereby ensuring that the robot arm 13 and/or the pulling mechanism 14 do not cause damage to people or equipment.
For example, the preset pressure value is 300Pa, and when the safety limit sensor detects that the pressure received by the magnet of the mechanical arm 13 or the traction mechanism 14 exceeds 300Pa, the power supply circuit of the mechanical arm 13 or the traction mechanism 14 is cut off, so that the mechanical arm 13 or the traction mechanism 14 can stop working in time, and further damage is prevented.
Further, in order to better ensure that the robot arm 13 does not hurt people due to too low height, a distance sensor 131 which is arranged on the robot arm 13 and connected with the upper computer 111 in the operation platform 11 is additionally arranged on the robot arm 13 and used for measuring the distance between the magnet of the robot arm 13 and the human body and feeding back the distance to the upper computer 111.
Specifically, the user may set a safe distance through the upper computer 111 in the console 11, and when the upper computer 111 receives that the distance sensor 131 detects that the distance between the magnet of the robot arm 13 and the human body is less than the safe distance, the upper computer 111 prohibits the robot arm 13 from moving further downward, for example, the distance sensor 131 may be an ultrasonic sensor, the distance sensor 131 may convert the position information into a voltage of 0 to 10V, for example, the highest distance between the magnet and the patient bed is 700mm, the position distance of 700mm is mapped to the voltage, so that the voltage of 10V corresponds to the distance of 700mm, and the voltage of 1V is equal to 70mm, the distance sensor 131 feeds back the distance information, for example, the distance between the magnet and the human body is 200mm, 200mm/70 is 2.857V, the distance sensor 131 feeds back the voltage of 2.857V to the upper computer 111, so that the user can observe the distance between the magnet and the patient, further improve the security, simultaneously, the user can also set up safe distance threshold through host computer 111, makes the voltage that distance sensor 131 feedbacks can not be less than the threshold of setting, for example, host computer 111 sets up the position that can not be less than 50mm, then 50mm/70 equals 0.714V, the threshold is 0.714V, when the voltage that distance sensor 131 feedbacks reaches 0.714V, then operation panel 11 is not handling the instruction that makes arm 13 move down that the user input to the safety of protection disease.
It should be noted that, since the upper computer 111 in the console 11 may not be able to directly receive the voltage signal fed back by the distance sensor 131, the distance sensor 131 and the upper computer 111 are connected by a digital-to-analog converter, and an analog signal fed back by the distance sensor 131 is converted into a digital signal that can be received by the upper computer 111 by the digital-to-analog converter, so that the upper computer 111 can receive the position information.
Specifically, the digital-to-analog converter can be a single chip microcomputer comprising an STC15 chip, a USB serial port, an analog input terminal and an RC filter circuit, the single chip microcomputer can adopt 8-bit AD acquisition, the output digital quantity range is 0-255, when the resolution ratio is that the digital quantity changes by a minimum quantity, the variable quantity of the analog signal is represented by the digit number of the digital signal and is defined as full scale 2n-a ratio of 1.
Finally, it should also be noted that, herein, relational terms such as first and second, and the like may be used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions. Also, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or apparatus. Without further limitation, an element defined by the phrase "comprising an … …" does not exclude the presence of other identical elements in a process, method, article, or apparatus that comprises the element.
Those of skill would further appreciate that the various illustrative elements and algorithm steps described in connection with the embodiments disclosed herein may be implemented as electronic hardware, computer software, or combinations of both, and that the various illustrative components and steps have been described above generally in terms of their functionality in order to clearly illustrate this interchangeability of hardware and software. Whether such functionality is implemented as hardware or software depends upon the particular application and design constraints imposed on the implementation. Skilled artisans may implement the described functionality in varying ways for each particular application, but such implementation decisions should not be interpreted as causing a departure from the scope of the present invention.
The magnetic force attitude controller provided by the invention is described in detail above, and the principle and the implementation mode of the invention are explained by applying specific examples, and the description of the examples is only used for helping to understand the method and the core idea of the invention; meanwhile, for a person skilled in the art, according to the idea of the present invention, there may be variations in the specific embodiments and the application scope, and in summary, the content of the present specification should not be construed as a limitation to the present invention.

Claims (8)

1. A magnetic attitude controller, comprising: the device comprises an operating platform, a control cabinet, a mechanical arm and a traction mechanism; the mechanical arm and the traction mechanism are both provided with magnets for controlling a controlled object to move, the mechanical arm and the traction mechanism are vertically arranged, and the mechanical arm is positioned above the traction mechanism;
the console is used for receiving a control instruction input by a user, generating and sending a controlled object control signal to the control cabinet according to the control instruction;
the control cabinet is used for receiving the controlled object control signal, converting the controlled object control signal into a first analog signal and a second analog signal, sending the first analog signal to the mechanical arm and sending the second analog signal to the traction mechanism;
the mechanical arm is used for controlling the controlled object to move by utilizing the first analog signal;
the traction mechanism is used for controlling the controlled object to move by utilizing the second analog signal.
2. The magnetic attitude controller of claim 1, wherein the console comprises:
the mechanical arm control module is used for generating a controlled object control signal by using the control instruction, sending the controlled object control signal to the control cabinet and sending the controlled object control signal to the traction mechanism control unit;
and the traction mechanism control module is used for generating a following control signal by utilizing the controlled object control signal and sending the following control signal to the control cabinet.
3. The magnetic attitude controller of claim 2, wherein the robotic arm control module comprises:
and the control signal generating unit is used for generating a controlled object control signal according to the control command by utilizing an interpolation algorithm.
4. The magnetic attitude controller of claim 2, wherein the traction mechanism control module comprises:
and the control signal generating unit is used for generating the following control signal according to the controlled object control signal by utilizing an electronic gear following algorithm.
5. The magnetic attitude controller according to any one of claims 1 to 4, further comprising:
the first limit sensor is connected in series with a power supply circuit of a mechanical arm in the control cabinet and is used for cutting off the power supply circuit of the mechanical arm when the pressure exceeding a threshold value on the magnet of the mechanical arm is detected;
and the second limit sensor is connected in series with a power supply circuit of the traction mechanism in the control cabinet and is used for cutting off the power supply circuit of the traction mechanism when detecting that the pressure exceeding a threshold value is applied to the magnet of the traction mechanism.
6. The magnetic attitude controller according to any one of claims 1 to 4, further comprising:
and the distance sensor is arranged on the mechanical arm and connected with the upper computer in the operating table, and is used for measuring the distance between the magnet of the mechanical arm and the human body and feeding back the distance to the upper computer.
7. The magnetic attitude controller of claim 6, wherein the distance sensor is connected to the upper computer through a digital-to-analog converter.
8. The magnetic attitude controller of claim 7, wherein the digital-to-analog converter is a single chip microcomputer including an STC15 chip, a USB serial port, an analog input terminal, and an RC filter circuit.
CN201810002433.9A 2018-01-02 2018-01-02 A kind of magnetic force attitude controller Pending CN108354576A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810002433.9A CN108354576A (en) 2018-01-02 2018-01-02 A kind of magnetic force attitude controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810002433.9A CN108354576A (en) 2018-01-02 2018-01-02 A kind of magnetic force attitude controller

Publications (1)

Publication Number Publication Date
CN108354576A true CN108354576A (en) 2018-08-03

Family

ID=63010512

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810002433.9A Pending CN108354576A (en) 2018-01-02 2018-01-02 A kind of magnetic force attitude controller

Country Status (1)

Country Link
CN (1) CN108354576A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109259716A (en) * 2018-09-04 2019-01-25 北京理工大学 A kind of capsule endoscope magnetic guide control device
CN112802652A (en) * 2021-01-15 2021-05-14 无锡声亚医疗科技有限公司 Reliable control circuit applied to direct current electromagnet control mechanical arm
CN116115349A (en) * 2023-04-18 2023-05-16 中国科学院理化技术研究所 Needle insertion manipulator control system and minimally invasive surgery robot

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102946785A (en) * 2010-06-15 2013-02-27 奥林巴斯医疗株式会社 Method and apparatus for displaying information in magnetically guided capsule endoscopy
CN103169443A (en) * 2013-03-29 2013-06-26 哈尔滨工业大学深圳研究生院 Magnetic control active capsule endoscope motion control system based on smart robot
CN203244366U (en) * 2013-03-29 2013-10-23 哈尔滨工业大学深圳研究生院 Magnetic control active type capsule endoscope motion control system based on flexible robot
CN105852783A (en) * 2016-04-22 2016-08-17 重庆金山科技(集团)有限公司 Capsule endoscope control system

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102946785A (en) * 2010-06-15 2013-02-27 奥林巴斯医疗株式会社 Method and apparatus for displaying information in magnetically guided capsule endoscopy
CN103169443A (en) * 2013-03-29 2013-06-26 哈尔滨工业大学深圳研究生院 Magnetic control active capsule endoscope motion control system based on smart robot
CN203244366U (en) * 2013-03-29 2013-10-23 哈尔滨工业大学深圳研究生院 Magnetic control active type capsule endoscope motion control system based on flexible robot
CN105852783A (en) * 2016-04-22 2016-08-17 重庆金山科技(集团)有限公司 Capsule endoscope control system

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109259716A (en) * 2018-09-04 2019-01-25 北京理工大学 A kind of capsule endoscope magnetic guide control device
CN109259716B (en) * 2018-09-04 2021-03-09 北京理工大学 Capsule endoscope magnetic guide control device
CN112802652A (en) * 2021-01-15 2021-05-14 无锡声亚医疗科技有限公司 Reliable control circuit applied to direct current electromagnet control mechanical arm
CN116115349A (en) * 2023-04-18 2023-05-16 中国科学院理化技术研究所 Needle insertion manipulator control system and minimally invasive surgery robot

Similar Documents

Publication Publication Date Title
CN108354576A (en) A kind of magnetic force attitude controller
CN107921624B (en) Industrial remote operation robot system
CN107717982B (en) Control device and operation method of mechanical arm
KR100857149B1 (en) Telescopic servomanipulator coupling/decoupling apparatus
CN105171725B (en) Articulated robot with exercise assist device
CN206690125U (en) One kind crawl force adaptive paw
CN107472871A (en) A kind of automatic tipping arrangement for automatic production line
Struijk et al. Fully integrated wireless inductive tongue computer interface for disabled people
CN108340374A (en) A kind of control system and control method of picking mechanical arm
CN215067868U (en) DCS system for monitoring and diagnosing industrial field environment and equipment
CN105128009A (en) Bionic robot with object shape and pose accurate sensing function and sensing method of bionic robot
CN107717996B (en) Stop the articulated robot and ranging method of shutting down of function with ranging
CN106344341A (en) Embedded system of hand rehabilitation robot
US20200306993A1 (en) Robotic gripper with integrated tactile sensor arrays
US20180215044A1 (en) Image processing device, robot control device, and robot
CN209737631U (en) Somatosensory control type bionic mechanical arm for underwater robot
CN106406323A (en) Adaptive precision motion control method for mobile platform based on Beidou-GPS navigation
CN112429185A (en) Multistage-driving bionic underwater robot driving system and driving method
CN114224627A (en) Control device and control method for electric wheelchair
CN102631767A (en) Upper arm extension exercise correcting device and method
CN207509223U (en) A kind of intelligent industrial robot
CN202637856U (en) Exercise, movement and correction device for flexion and extension of upper arms
CN114176489A (en) Magnetic control system of magnetic suspension capsule robot
JP2022526351A (en) Robot gripper and how to operate the robot gripper
CN110143503A (en) Elevator safety component test facility and system

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20180803