Servo control system and robot
AssigneeUbtech Robotics Corp Ltd
InventorsDong Liu, Youjun Xiong
Life of this patent
Estimating the term…
Abstract
The present invention provides a servo control system and a robot. The servo control system is applied to a servo, and includes a main control module including an angle information receiving terminal and a detection control terminal; and an angle collection module including a magnet and a magnetic encoding chip spaced apart from the magnet by a certain distance. The magnet is connected to a rotation output shaft of the servo. The magnetic encoding chip includes an angle information output terminal and a detection control receiving terminal. In the above manner, the present invention can accurately acquire position information of a servo.
Claims17
A servo control system, applied to a servo, wherein the servo control system comprises:
- a main control module, comprising an angle information receiving terminal and a detection control terminal;
- an angle collection module, comprising a magnet and a magnetic encoding chip spaced apart from the magnet by a certain distance, the magnet being connected to a rotation output shaft of the servo, the magnetic encoding chip comprising an angle information output terminal and a detection control receiving terminal, the angle information output terminal being coupled to the angle information receiving terminal of the main control module, and the detection control receiving terminal being coupled to the detection control terminal of the main control module;
- wherein:
- when rotating, the rotation output shaft drives the magnet to rotate, the main control module controls, via the detection control terminal and the detection control receiving terminal, the magnetic encoding chip to sense information of changing magnetic field generated when the magnet rotates, the magnetic encoding chip senses information of rotation angle of the rotation output shaft of the servo according to the information of changing magnetic field, and the main control module receives, via the angle information output terminal and the angle information receiving terminal, the information of rotation angle of the rotation output shaft, and controls rotation of the servo according to the information of angle;
- wherein the magnet is arranged at an end of the rotation output shaft of the servo and comprises of one N type first magnet and one S type second magnet, and a plane of the magnet is substantially parallel to a plane of the magnetic encoding chip;
- wherein the servo control system further comprises a power supply module and a charge detection module coupled to the main control module, the power supply module is configured to provide a power supply for the servo, and the charge detection module is configured to detect a charge of a battery inside the servo;
- wherein the power supply module comprises a first low dropout regulator, a first capacitor, a second capacitor, a third capacitor, a fourth capacitor, a fifth capacitor, a sixth capacitor, and a second low dropout regulator;
- the first capacitor and the second capacitor are connected to each other in parallel between a first voltage terminal and a ground, and the first voltage terminal provides a reference power supply voltage converted into a first power supply voltage through the first low dropout regulator;
- the third capacitor and the fourth capacitor are connected to each other in parallel between a second voltage terminal and a ground, the first power supply voltage is converted into a second power supply voltage through the second low dropout regulator;
- the fifth capacitor and the sixth capacitor are connected to each other in parallel between a third voltage terminal and a ground, the second voltage terminal outputs a second power supply voltage, and the third voltage terminal outputs a second power supply voltage.
A robot, comprising a central processor and a plurality of servos coupled to the central processor, wherein each servo comprises a servo control system, the servo control system comprises:
- a main control module, comprising an angle information receiving terminal and a detection control terminal;
- an angle collection module, comprising a magnet and a magnetic encoding chip spaced apart from the magnet by a certain distance, the magnet being connected to a rotation output shaft of the servo, the magnetic encoding chip comprising an angle information output terminal and a detection control receiving terminal, the angle information output terminal being coupled to the angle information receiving terminal of the main control module, and the detection control receiving terminal being coupled to the detection control terminal of the main control module;
- wherein:
- when rotating, the rotation output shaft drives the magnet to rotate, the main control module controls, via the detection control terminal and the detection control receiving terminal, the magnetic encoding chip to sense information of changing magnetic field generated when the magnet rotates, the magnetic encoding chip senses information of rotation angle of the rotation output shaft of the servo according to the information of changing magnetic field, and the main control module receives, via the angle information output terminal and the angle information receiving terminal, the information of rotation angle of the rotation output shaft, and controls rotation of the servo according to the information of angle;
- wherein the magnet is arranged at an end of the rotation output shaft of the servo and comprises of one N type first magnet and one S type second magnet, and a plane of the magnet is substantially parallel to a plane of the magnetic encoding chip;
- wherein the servo control system further comprises a power supply module and a charge detection module coupled to the main control module, the power supply module is configured to provide a power supply for the servo, and the charge detection module is configured to detect a charge of a battery inside the servo;
- wherein the power supply module comprises a first low dropout regulator, a first capacitor, a second capacitor, a third capacitor, a fourth capacitor, a fifth capacitor, a sixth capacitor, and a second low dropout regulator;
- the first capacitor and the second capacitor are connected to each other in parallel between a first voltage terminal and a ground, and the first voltage terminal provides a reference power supply voltage converted into a first power supply voltage through the first low dropout regulator;
- the third capacitor and the fourth capacitor are connected to each other in parallel between a second voltage terminal and a ground, the first power supply voltage is converted into a second power supply voltage through the second low dropout regulator;
- the fifth capacitor and the sixth capacitor are connected to each other in parallel between a third voltage terminal and a ground, the second voltage terminal outputs a second power supply voltage, and the third voltage terminal outputs a second power supply voltage.
Dependencies are inferred from the claim text.