CN201716570U - Modularized reconstructible robot joint module control device - Google Patents
Modularized reconstructible robot joint module control device Download PDFInfo
- Publication number
- CN201716570U CN201716570U CN2009202882167U CN200920288216U CN201716570U CN 201716570 U CN201716570 U CN 201716570U CN 2009202882167 U CN2009202882167 U CN 2009202882167U CN 200920288216 U CN200920288216 U CN 200920288216U CN 201716570 U CN201716570 U CN 201716570U
- Authority
- CN
- China
- Prior art keywords
- module
- pin
- chip
- links
- interface module
- 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.)
- Expired - Lifetime
Links
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Abstract
The utility model relates to a modularized reconstructible robot, in particular to a modularized reconstructible robot joint module control device. A DSP chip unit signal input end is connected with a CAN communication module, an analogue signal module, a potentiometer interface module, a photoelectric encoder interface module, a Hall sensor interface module, a connection sequence identification interface module, a zero pole position switch module and an electric encoder interface module. The DSP chip unit signal output end is connected with a brake control module, an optical coupling isolation chip module, and a driving logic chip module. A power supply converting module is used for supplying power to various modules, the brake control module is used for dropping the power to brake, therefore the reconstructible robot can drop to brake suddenly during the movement process, and ensure the safety. The control device has high integrated level and strong expansibility, can realize the joint module resetting, connection sequence identification, position information redundant fault tolerance, and precise servo, and has the power stopping brake and over-current protection functions.
Description
Technical field
The utility model relates to Robot Control Technology, specifically is the joint module control device of a kind of modular reconfigurable robot.
Background technology
The modular reconfigurable robot is made up of modules such as a series of joints with different size and functional character, connecting rods, can with the mode that plays with building blocks by between the module simply, assembly and disassembly fast change one-piece construction, reconfigure the robot of configuration.For traditional fixed configuration robot, the modular reconfigurable robot can realize " a cover member, multiple configuration ", can select best robot architecture according to mission requirements, thereby stronger to the adaptability and the work capacity of complex environment.
The electromechanical integration method is adopted in the design of the joint module of modular reconfigurable robot mostly, and the physical construction and the control device that are about to single joint module are designed to one, exists with physical location form independently.Single joint module can be formed a robot jointly with other module, also can carry out independent control to it.Therefore, how to design the control device of joint module, make it and can not only fully merge with one-piece construction, and the better controlled performance can be arranged, this is a gordian technique of modular reconfigurable robot design.
Joint module adopts motor as driving components and parts usually.Characteristics such as dc brushless motor is good because of the linearity of its mechanical property and control characteristic, speed adjustable range is wide, volume is little, the life-span is long, noise is low are used more and more wider the robot field.But the commutation of dc brushless motor and speed regulating control are comparatively complicated, require very high to control system computing and information processing capability; The pid parameter adjustment of joint module and servo accuracy are the key factors that influences the robot control performance, thereby the precision of its control system and real-time just seem particularly important; The joint module quantity of forming robot is many more, and the transinformation of its distributed control is just big more, and communication process is also complicated more, and this communication design to the joint module control system is had higher requirement; Therefore the size of joint module self and weight all can not be excessive, and being integrated in its inner control system also must compact conformation, rationally distributed; In addition, how to improve the security that joint module moves from the control angle, and problems such as the reliability of control system self, robustness and extendability.Above-mentioned technological difficulties make existing module controller be difficult to satisfy the control and the reconfiguration request of joint module, have influenced the actual exploitation and the application of modular reconfigurable robot.
The utility model content
At above shortcomings in the prior art, the purpose of this utility model be to provide a kind of integrated level height, device extendability strong, can realize that joint module resets, order of connection identification, positional information redundancy fault-tolerant, elaborate servo, have the joint module control device of a kind of modular reconfigurable robot of power down braking and overcurrent protection function.
The technical scheme that its technical matters that solves the utility model adopts is as follows:
The joint module control device of a kind of modular reconfigurable robot is a core with the dsp chip, and described dsp chip unit one signal input part is connected with power transfer module by the CAN communication module; Its another signal input part is connected with Driving Field effect tube module output terminal by the simulating signal module; Its another signal input part is connected with the pot interface module; Its another signal input part is connected with the dc brushless motor interface module by the photoelectric encoder interface module; Its another signal input part is connected with the dc brushless motor interface module by the Hall element interface module; Its another signal input part is connected with the electrostatic protection chip module by order of connection recognition interface module; Its another signal input part is connected with the electrostatic protection chip module by zero utmost point bit switch module; Its another signal input part is connected with electrostatic protection chip module output terminal by the photoelectric encoder interface module; Described dsp chip unit one signal output part is connected with detent control module signal input part; Its another signal output part is connected with Driving Field effect tube module signal input part with driving logic chip module by the light-coupled isolation chip module successively; Described power transfer module input end is connected with direct supply interface module output terminal with detent control module input end; Described power transfer module input end is connected with CAN communication module, light-coupled isolation chip module, driving logic chip module, detent control module and zero utmost point bit switch module respectively; Described direct supply interface module output terminal is connected with Driving Field effect tube module by the sampling resistor module; Described Driving Field effect tube module is connected with dc brushless motor interface module input end with the simulating signal module respectively.
Described power transfer module comprises, the first voltage transitions chip, the second voltage transitions chip, tertiary voltage conversion chip, the 4th voltage transitions chip; The described first voltage transitions chip and the second voltage transitions chip I NPUT pin and direct supply interface module+the 24V pin links to each other; The INPUT pin of described tertiary voltage conversion chip and the 4th voltage transitions chip links to each other with the second voltage transitions chip OUTPUT pin; The OUTPUT pin of the described first voltage transitions chip links to each other with the VCC pin that drives the logic chip module; The described second voltage transitions chip OUTPUT pin also links to each other with the VCC pin of CAN communication module, light-coupled isolation chip module, zero utmost point bit switch module, Hall element interface module, photoelectric encoder interface module and detent control module; Described tertiary voltage conversion chip OUTPUT pin links to each other with the VCC pin of dsp chip unit, simulating signal module, pot interface module and order of connection recognition interface module; Described the 4th voltage transitions chip OUTPUT pin links to each other with dsp chip unit VDD pin.
Described CAN communication module comprises, CAN chip for driving and CAN Bussing connector;
The CANH of described CAN chip for driving, CANL pin link to each other with CAN Bussing connector CANH, CANL pin respectively; The TXD of described CAN chip for driving, RXD pin link to each other with CANTX, the CANRX pin of dsp chip unit respectively; The VCC pin of described CAN chip for driving links to each other with the OUTPUT pin of the second voltage transitions chip in the power transfer module.
Described light-coupled isolation chip module comprises, first～the 6th opto-coupler chip; The INPUT pin of described first～the 6th opto-coupler chip links to each other with PWM1, PWM2, PWM3, PWM4, PWM5, the PWM6 pin of dsp chip unit respectively; The OUTPUT pin of described first～the 6th opto-coupler chip is connected with HIN1, the LIN1, HIN2, LIN2, HIN3, the LIN3 pin that drive the logic chip module respectively; The VCC pin of described first～the 6th opto-coupler chip is connected with the OUTPUT pin of the second voltage transitions chip in the power transfer module.
Described Driving Field effect tube module comprises, first～the 6th field effect transistor; The grid of described first～the 6th field effect transistor links to each other with HO1, HO2, HO3, LO1, LO2, the LO3 pin of logical drive chip module respectively, and the source electrode of described first～the 3rd field effect transistor links to each other with VS1, VS2, the VS3 pin of logical drive chip module respectively; The drain electrode of described the 4th～the 6th field effect transistor links to each other with VS1, the VS2, the VS3 pin that drive the logic chip module respectively, the drain electrode of described first～the 3rd field effect transistor links to each other with direct supply interface module+24V pin respectively, the source electrode of described the 4th～the 6th field effect transistor links to each other with sampling resistor respectively
VS1, the VS2, the VS3 pin that drive the logic chip module link to each other with MA, MB, the MC pin of dc brushless motor interface module respectively.
Described zero utmost point bit switch module comprises zero-bit switch, the first～the second utmost point bit switch; The OUTPUT pin of described zero-bit switch, the first～the second utmost point bit switch links to each other with GPIOB3, GPIOB2, the GPIOB1 pin of dsp chip unit respectively; The OUTPUT pin of described zero-bit switch, the first～the second utmost point bit switch links to each other with INPUT1, INPUT2, the INPUT3 pin of electrostatic protection chip module respectively; The VCC pin of described zero-bit switch, the first～the second utmost point bit switch links to each other with the OUTPUT pin of voltage transitions chip module in the power transfer module respectively.
The HALL1 of described Hall element interface module, HALL2, HALL3 pin link to each other with GPIOB8, GPIOB7, the GPIOB6 pin of dsp chip unit respectively; The HALL1 of described Hall element interface, HALL2, HALL3 pin link to each other with INPUT4, INPUT5, the INPUT6 pin of electrostatic protection chip module respectively; The VCC pin of described Hall element interface links to each other with the OUTPUT pin of voltage transitions chip in the power conversion unit; The INPUT of described order of connection recognition interface module, OUTPUT pin link to each other with GPIOA11, the GPIOA12 pin of dsp chip unit respectively; The INPUT of described order of connection recognition interface module, OUTPUT pin link to each other with INPUT10, the INPUT11 pin of electrostatic protection chip module respectively.
The A of described photoelectric encoder interface module, B pin link to each other with QEP1, the QEP2 pin of dsp chip unit respectively by resistance; The A of described photoelectric encoder interface module, B pin link to each other with INPUT7, the INPUT8 pin of electrostatic protection chip module respectively; The VCC pin of described photoelectric encoder interface links to each other with the OUTPUT pin of voltage transitions chip in the power transfer module; The OUTPUT pin of described pot interface module links to each other with the ADCINB3 pin of dsp chip unit; The OUTPUT pin of described pot interface module links to each other with the INPUT9 pin of electrostatic protection chip module; The VCC pin of described pot interface module links to each other with the OUTPUT pin of voltage transitions chip in the power transfer module; Described detent control module comprises, the 7th opto-coupler chip, the 7th field effect transistor, detent; The OUTPUT pin of described the 7th opto-coupler chip links to each other with the grid of the 7th field effect transistor, and the drain electrode of the 7th field effect transistor links to each other the source ground of the 7th field effect transistor with the IN-pin of detent; The INPUT pin of described the 7th opto-coupler chip links to each other with the GPIOB0 pin of DSP chip unit; The IN+ pin of described detent BREAK links to each other with direct supply interface module+24V pin.
Described simulating signal module comprises, primary amplifier, secondary amplifier; The IN+ of described primary amplifier, IN-pin are connected between sampling resistor and the Driving Field effect tube module.
The OUTPUT pin of described primary amplifier links to each other with the IN-pin of secondary amplifier; The VCC pin of described primary amplifier links to each other with the OUTPUT pin of voltage transitions chip in the power transfer module; The IN+ pin of described secondary amplifier passes through resistance eutral grounding; The OUTPUT pin of described secondary amplifier links to each other with the ADCINA3 pin of dsp chip unit, and the VCC pin of described secondary amplifier links to each other with the OUTPUT pin of voltage transitions chip in the power conversion unit.
The controlled step flow process of described dsp chip unit is:
Initialization dsp controller at first;
Enter the initial state T1 of loop body then;
After carrying out the configuration identification, judge whether to carry out configuration identification instruction?
If, then do not return initial state T1; If yes, then carry out order of connection identification T2;
After carrying out order of connection identification T2, judge whether the identification success?
If, then do not return initial state T1; If yes, then carry out no position reference T3;
After carrying out no position reference T3, judge whether to carry out back zero instruction?
If, then do not return no position reference T3; If yes, then carry out back zero T4;
After carrying out back zero T4, judge whether back zero success?
If, then do not return no position reference T3;
If yes, then execution has position reference T5;
After execution has position reference T5, judge whether to carry out movement instruction?
If, then do not return to carry out position reference T5 arranged;
If yes, then carry out the T6 that is synchronized with the movement;
Execution is synchronized with the movement behind the T6, judge whether that motion finishes?
Do not carry out the T6 that is synchronized with the movement if, then return;
If yes, then return execution position reference T5 is arranged.
In the above-mentioned control flow loop body carry out each state correspondence code, interrupt according to state transitions rule switching state, response; The interrupt management module of DSP kernel comprises that Intr1 is interrupted in the AD conversion, cpu clock interrupts Intr2, QEP interruption Intr3, CAN reception and interrupts Intr4.
Advantage of the present utility model:
1. core processor of the present utility model adopts the high-speed digital signal process chip, on arithmetic speed and data-handling capacity, can satisfy the high real-time requirement of motion control, for the compound movement control that realizes the modular reconfigurable robot provides reliable platform.
2. communication mode of the present utility model adopts the CAN bus mode, advantages such as the CAN bus communication has that interface is simple, broadcast communication, short frame transmitting-receiving, extendability are strong, robot increase and decrease module does not influence system works, has solved the complex interfaces problem of point-to-point transmission mode.
3. joint motions positional information feedback of the present utility model adopts incremental optical-electricity encoder interface module and the design of pot interface module redundancy fault-tolerant, utilize the auxiliary small change of pot and differentiate limit position, utilize scrambler accurately to locate, and can be by the comparison and detection fault of photoelectric encoder interface module and pot interface module, the robustness of device is good.
4. sampling resistor module of the present utility model obtains the current information of motor, realizes speed ring, position ring PID control based on electric current loop, and can realize the overcurrent protection to motor.
5. detent control module power down braking of the present utility model makes the power down suddenly in motion process of modular reconfigurable robot can not cause accident, has improved the security of device.
Description of drawings
Fig. 1 is a control device structured flowchart of the present utility model;
Fig. 2 is the circuit theory diagrams of this control device;
Fig. 3 is the synoptic diagram of power transfer module in this control device;
Fig. 4 is the synoptic diagram of CAN communication module in this control device;
Fig. 5 is the synoptic diagram of light-coupled isolation chip module in this control device;
Fig. 6 is the synoptic diagram of Driving Field effect tube module in this control device;
Fig. 7 is the synoptic diagram of zero utmost point bit switch module in this control device;
Fig. 8 is the synoptic diagram of Hall element interface module in this control device;
Fig. 9 is the synoptic diagram of photoelectric encoder interface module in this control device;
Figure 10 is the synoptic diagram of simulating signal module in this control device;
Figure 11 is the synoptic diagram of detent control module in this control device;
Figure 12 is the synoptic diagram of pot interface module in this control device;
Figure 13 is the synoptic diagram of order of connection recognition interface module in this control device;
Figure 14 is the control flow chart of the utility model control device.
Embodiment
Below in conjunction with accompanying drawing the utility model is further described.
Shown in Fig. 1～13, the joint module control device of a kind of modular reconfigurable robot, with dsp chip U2 is core, and commercial product type is: TMS320F2812, and described dsp chip unit U2 one signal input part is connected with power transfer module U1 by CAN communication module U3; Its another signal input part is connected with Driving Field effect tube module U6 output terminal by simulating signal module U10; Its another signal input part is connected with pot interface module U12; Its another signal input part is connected with dc brushless motor interface module U17 by photoelectric encoder interface module U9; Its another signal input part is connected with dc brushless motor interface module U17 by Hall element interface module U8; Its other three signal input parts are connected with electrostatic protection chip module U13 output terminal by order of connection recognition interface module U15, zero utmost point bit switch module U7 and photoelectric encoder interface module U9 respectively; Described dsp chip unit U2 one signal output part is connected with detent control module U11 signal input part; Its another signal output part is connected with Driving Field effect tube module U6 signal input part with driving logic chip module U5 by light-coupled isolation chip module U4 successively; Described power transfer module U1 input end is connected with direct supply interface module U14 output terminal with detent control module U11 input end; Described power transfer module U1 input end is connected with zero utmost point bit switch module U7 with CAN communication module U3, light-coupled isolation chip module U4, driving logic chip module U5, detent control module U11 respectively; Described direct supply interface module U14 output terminal is connected with Driving Field effect tube module U6 by sampling resistor U16 module; Described Driving Field effect tube module U6 is connected with dc brushless motor interface module U17 input end with simulating signal module U10 respectively.
Described power transfer module U1 comprises, the first voltage transitions chip U18, the second voltage transitions chip U19, tertiary voltage conversion chip U20, the 4th voltage transitions chip U21; The INPUT pin of the described first voltage transitions chip U18 and the second voltage transitions chip U19 and direct supply interface module U14+the 24V pin links to each other; The INPUT pin of described tertiary voltage conversion chip U20 and the 4th voltage transitions chip U21 links to each other with the OUTPUT pin of the second voltage transitions chip U19; The OUTPUT pin of the described first voltage transitions chip U18 links to each other with the VCC pin that drives logic chip module U5; The OUTPUT pin of the described second voltage transitions chip U19 also links to each other with the VCC pin of CAN communication module U3, light-coupled isolation chip module U4, zero utmost point bit switch module U7, Hall element interface module U8, photoelectric encoder interface module U9 and detent control module U11; The OUTPUT pin of described tertiary voltage conversion chip U20 links to each other with the VCC pin of dsp chip unit U2, simulating signal module U10, pot interface module U12 and order of connection recognition interface module U15; The OUTPUT pin of described the 4th voltage transitions chip U21 links to each other with the VDD pin of dsp chip unit U2.The external 24V dc power supply of described power transfer module U1 converts 12V, 5V, 3.3V, 1.9V DC voltage to satisfy the control device requirements of one's work by the first voltage transitions chip U18, the second voltage transitions chip U19, tertiary voltage conversion chip U20 and the 4th voltage transitions chip U21 and with the 24V DC voltage.
Described CAN communication module U3 comprises, CAN chip for driving U22 and CAN Bussing connector U23; The CANH of described CAN chip for driving U22, CANL pin link to each other with CANH, the CANL pin of CAN Bussing connector U23 respectively; The TXD of described CAN chip for driving U22, RXD pin link to each other with CANTX, the CANRX pin of dsp chip unit U2 respectively; The VCC pin of described CAN chip for driving U22 links to each other with the OUTPUT pin of the second voltage transitions chip U19 among the power transfer module U1.Communications portion of the present utility model adopts the CAN bus mode, advantages such as the CAN bus communication has that interface is simple, broadcast communication, short frame transmitting-receiving, extendability are strong, robot increase and decrease module does not influence device work, has solved the complex interfaces problem of point-to-point transmission mode.
Described light-coupled isolation chip module U4 comprises, first～the 6th opto-coupler chip O1, O2, O3, O4, O5, O6; The INPUT pin of described first～the 6th opto-coupler chip O1, O2, O3, O4, O5, O6 links to each other with PWM1, PWM2, PWM3, PWM4, PWM5, the PWM6 pin of dsp chip unit U2 respectively; The OUTPUT pin of described first～the 6th opto-coupler chip O1, O2, O3, O4, O5, O6 is connected with HIN1, the LIN1, HIN2, LIN2, HIN3, the LIN3 pin that drive logic chip module U5 respectively; The VCC pin of described first～the 6th opto-coupler chip O1, O2, O3, O4, O5, O6 is connected with the OUTPUT pin of the second voltage transitions chip U19 among the power transfer module U1.
Described Driving Field effect tube module U6 comprises first～the 6th field effect transistor Q1, Q2, Q3, Q4, Q5, Q6; The grid of described first～the 6th field effect transistor Q1, Q2, Q3, Q4, Q5, Q6 links to each other with HO1, the HO2, HO3, LO1, LO2, the LO3 pin that drive logic chip module U5 respectively, and the source electrode of described first～the 3rd field effect transistor Q1, Q2, Q3 links to each other with VS1, the VS2, the VS3 pin that drive logic chip module U5 respectively; The drain electrode of described the 4th～the 6th field effect transistor Q4, Q5, Q6 links to each other with VS1, the VS2, the VS3 pin that drive logic chip module U5 respectively, the drain electrode of described first～the 3rd field effect transistor Q1, Q2, Q3 respectively with direct supply interface module U14+the 24V pin links to each other, the source electrode of described the 4th～the 6th field effect transistor Q4, Q5, Q6 links to each other with sampling resistor U16 respectively, and VS1, the VS2, the VS3 pin that drive logic chip module U5 link to each other with MA, MB, the MC pin of dc brushless motor interface module U17 respectively.
Described zero utmost point bit switch module U7 comprises zero-bit switch S 1, the first～the second utmost point bit switch S2, S3; The OUTPUT pin of described zero-bit switch S 1, the first～the second utmost point bit switch S2, S3 links to each other with GPIOB3, GPIOB2, the GPIOB1 pin of dsp chip unit U2 respectively; The OUTPUT pin of described zero-bit switch S 1, the first～the second utmost point bit switch S2, S3 links to each other with INPUT1, INPUT2, the INPUT3 pin of electrostatic protection chip module U13 respectively; The VCC pin of described zero-bit switch S 1, first～the 3rd utmost point bit switch S2, S3 links to each other with the OUTPUT pin of voltage transitions chip module U19 among the power transfer module U1 respectively.
HALL1, the HALL2 of described Hall element interface module U8, HALL3 pin link to each other with GPIOB8, GPIOB7, the GPIOB6 pin of dsp chip unit U2 respectively; HALL1, the HALL2 of described Hall element interface module U8, HALL3 pin link to each other with INPUT4, INPUT5, the INPUT6 pin of electrostatic protection chip module U13 respectively; The VCC pin of described Hall element interface U8 links to each other with the OUTPUT pin of voltage transitions chip U19 among the power conversion unit U1.
The A of described photoelectric encoder interface module U9, B pin link to each other with QEP1, the QEP2 pin of dsp chip unit U2 respectively by resistance; The A of described photoelectric encoder interface module U9, B pin link to each other with INPUT7, the INPUT8 pin of electrostatic protection chip module U13 respectively, and the VCC pin of described photoelectric encoder interface U9 links to each other with the OUTPUT pin of voltage transitions chip U19 among the power transfer module U1.
Described simulating signal module U10 comprises, primary amplifier U24, secondary amplifier U25; The IN+ of described primary amplifier U24, IN-pin link to each other with sampling resistor U16 two ends respectively; The OUTPUT pin of described primary amplifier U24 links to each other with the IN-pin of secondary amplifier U25, and the VCC pin of described primary amplifier U24 links to each other with the OUTPUT pin of voltage transitions chip U19 among the power transfer module U1; The IN+ pin of described secondary amplifier U25 passes through resistance eutral grounding; The OUTPUT pin of described secondary amplifier U25 links to each other with the ADCINA3 pin of dsp chip unit U2, and the VCC pin of described secondary amplifier U25 links to each other with the OUTPUT pin of voltage transitions chip U20 among the power conversion unit U1.
Described detent control module U11 comprises, the 7th opto-coupler chip O7, the 7th field effect transistor Q7, detent BREAK; The OUTPUT pin of described the 7th opto-coupler chip O7 links to each other with the grid of the 7th field effect transistor Q7, and the drain electrode of the 7th field effect transistor Q7 links to each other the source ground of the 7th field effect transistor Q7 with the IN-pin of detent BREAK; The INPUT pin of described the 7th opto-coupler chip O7 links to each other with the GPIOB0 pin of dsp chip unit U2; The IN+ pin of described detent BREAK and direct supply interface module U14+the 24V pin links to each other.Detent control module 11 can allow does not need the joint of moving locked, can brake under the situation of power down suddenly, in case have an accident yet.
The OUTPUT pin of described pot interface module U12 links to each other with the ADCINB3 pin of dsp chip unit U2; The OUTPUT pin of described pot interface module U12 links to each other with the INPUT9 pin of electrostatic protection chip module U13; The VCC pin of described pot interface module U12 links to each other with the OUTPUT pin of voltage transitions chip U20 among the power transfer module U1.Pot interface module 12 sends to the AD modular converter of dsp chip with terminal output angle information, auxiliary small change position and judge whether code-disc breaks down.
The INPUT of described order of connection recognition interface module U15, OUTPUT pin link to each other with GPIOA11, the GPIOA12 pin of dsp chip unit U2 respectively; The INPUT of described order of connection recognition interface module U15, OUTPUT pin link to each other with INPUT10, the INPUT11 pin of electrostatic protection chip module U13 respectively.
It is that the dsp chip of TMS320F2812 is as master controller that the utility model dsp chip unit 2 adopts TI (Texas Instruments Incorporated) company's models.This chip is applicable to the control three-phase brushless dc motor, can directly export the required PWM ripple of three-phase brushless dc motor control from the TMS320F2812 chip internal, the photoelectric encoder decoder module is arranged, and 12 AD modular converters in the sheet, be easy to realize closed-loop control motor.
The pwm signal of the inner output of dsp chip arrives by light-coupled isolation chip module 4 and drives logic chip module 5.Driving the logic chip model is IR2130 (International Rectifier); IR2130 has the self-shield ability, and the unpredictable output in the time of can preventing the dsp chip initialization produces driving circuit and destroys, and drives field effect transistor by driving the floating signal controlling of driving of logic chip IR2130 generation.Photoelectric encoder becomes pulse signal with the rotation of motor, sends to the QEP decoding unit of dsp chip.Sampling resistor 16 obtains the current signal of motor, is converted into voltage signal by simulating signal unit module 10, sends to the AD modular converter of dsp chip, can realize the Current Control of motor.Realize speed closed loop and position closed loop on this basis, the control accuracy height.
As shown in figure 14.The control flow of dsp chip unit U2 is in the joint module control device of a kind of modular reconfigurable robot:
Initialization dsp controller at first;
Enter the initial state T1 of loop body then;
After carrying out the configuration identification, judge whether to carry out configuration identification instruction?
If, then do not return initial state T1; If yes, then carry out order of connection identification T2;
After carrying out order of connection identification T2, judge whether the identification success?
If, then do not return initial state T1; If yes, then carry out no position reference T3;
After carrying out no position reference T3, judge whether to carry out back zero instruction?
If, then do not return no position reference T3; If yes, then carry out back zero T4;
After carrying out back zero T4, judge whether back zero success?
If, then do not return no position reference T3;
If yes, then execution has position reference T5;
After execution has position reference T5, judge whether to carry out movement instruction?
If, then do not return to carry out position reference T5 arranged;
If yes, then carry out the T6 that is synchronized with the movement;
Execution is synchronized with the movement behind the T6, judge whether that motion finishes?
Do not carry out the T6 that is synchronized with the movement if, then return;
If yes, then return execution position reference T5 is arranged.
In the above-mentioned control flow loop body carry out each state correspondence code, interrupt according to state transitions rule switching state, response; The interrupt management module of DSP kernel comprises that Intr1 is interrupted in the AD conversion, cpu clock interrupts Intr2, QEP interruption Intr3, CAN reception and interrupts Intr4.
Claims (9)
1. the joint module control device of a modular reconfigurable robot is a core with the dsp chip, it is characterized in that:
Described dsp chip unit (U2) one signal input part is connected with power transfer module (U1) by CAN communication module (U3);
Its another signal input part is connected with Driving Field effect tube module (U6) output terminal by simulating signal module (U10);
Its another signal input part is connected with pot interface module (U12);
Its another signal input part is connected with dc brushless motor interface module (U17) by photoelectric encoder interface module (U9);
Its another signal input part is connected with dc brushless motor interface module (U17) by Hall element interface module (U8);
Its another signal input part is connected with electrostatic protection chip module (U13) by order of connection recognition interface module (U15);
Its another signal input part is connected with electrostatic protection chip module (U13) by zero utmost point bit switch module (U7);
Its another signal input part is connected with electrostatic protection chip module (U13) output terminal by photoelectric encoder interface module (U9);
Described dsp chip unit (U2) one signal output part is connected with detent control module (U11) signal input part;
Its another signal output part is connected with Driving Field effect tube module (U6) signal input part with driving logic chip module (U5) by light-coupled isolation chip module (U4) successively;
Described power transfer module (U1) input end is connected with direct supply interface module (U14) output terminal with detent control module (U11) input end;
Described power transfer module (U1) input end is connected with CAN communication module (U3), light-coupled isolation chip module (U4), driving logic chip module (U5), detent control module (U11) and zero utmost point bit switch module (U7) respectively;
Described direct supply interface module (U14) output terminal is connected with Driving Field effect tube module (U6) by sampling resistor (U16) module;
Described Driving Field effect tube module (U6) is connected with dc brushless motor interface module (U17) input end with simulating signal module (U10) respectively.
2. the joint module control device of a kind of modular reconfigurable as claimed in claim 1 robot, it is characterized in that: described power transfer module (U1) comprises, the first voltage transitions chip (U18), the second voltage transitions chip (U19), tertiary voltage conversion chip (U20), the 4th voltage transitions chip (U21);
The described first voltage transitions chip (U18) and second voltage transitions chip (U19) the INPUT pin and direct supply interface module (U14)+the 24V pin links to each other;
The INPUT pin of described tertiary voltage conversion chip (U20) and the 4th voltage transitions chip (U21) links to each other with second voltage transitions chip (U19) the OUTPUT pin;
The OUTPUT pin of the described first voltage transitions chip (U18) links to each other with the VCC pin that drives logic chip module (U5);
Described second voltage transitions chip (U19) the OUTPUT pin also links to each other with the VCC pin of CAN communication module (U3), light-coupled isolation chip module (U4), zero utmost point bit switch module (U7), Hall element interface module (U8), photoelectric encoder interface module (U9) and detent control module (U11);
Described tertiary voltage conversion chip (U20) OUTPUT pin links to each other with the VCC pin of dsp chip unit (U2), simulating signal module (U10), pot interface module (U12) and order of connection recognition interface module (U15);
Described the 4th voltage transitions chip (U21) OUTPUT pin links to each other with dsp chip unit (U2) VDD pin.
3. the joint module control device of a kind of modular reconfigurable as claimed in claim 1 robot, it is characterized in that: described CAN communication module (U3) comprises, CAN chip for driving (U22) and CAN Bussing connector (U23);
The CANH of described CAN chip for driving (U22), CANL pin link to each other with CAN Bussing connector (U23) CANH, CANL pin respectively;
The TXD of described CAN chip for driving (U22), RXD pin link to each other with CANTX, the CANRX pin of dsp chip unit (U2) respectively;
The VCC pin of described CAN chip for driving (U22) links to each other with the OUTPUT pin of the second voltage transitions chip (U19) in the power transfer module (U1).
4. the joint module control device of a kind of modular reconfigurable as claimed in claim 1 robot, it is characterized in that: described light-coupled isolation chip module (U4) comprises, first～the 6th opto-coupler chip (O1, O2, O3, O4, O5, O6);
The INPUT pin of described first～the 6th opto-coupler chip (O1, O2, O3, O4, O5, O6) links to each other with PWM1, PWM2, PWM3, PWM4, PWM5, the PWM6 pin of dsp chip unit (U2) respectively;
The OUTPUT pin of described first～the 6th opto-coupler chip (O1, O2, O3, O4, O5, O6) is connected with HIN1, the LIN1, HIN2, LIN2, HIN3, the LIN3 pin that drive logic chip module (U5) respectively;
The VCC pin of described first～the 6th opto-coupler chip (O1, O2, O3, O4, O5, O6) is connected with the OUTPUT pin of the second voltage transitions chip (U19) in the power transfer module (1).
5. the joint module control device of a kind of modular reconfigurable as claimed in claim 1 robot, it is characterized in that: described Driving Field effect tube module (6) comprises, first～the 6th field effect transistor (Q1, Q2, Q3, Q4, Q5, Q6);
The grid of described first～the 6th field effect transistor (Q1, Q2, Q3, Q4, Q5, Q6) links to each other with HO1, the HO2, HO3, LO1, LO2, the LO3 pin that drive logic chip module (U5) respectively,
The source electrode of described first～the 3rd field effect transistor (Q1, Q2, Q3) links to each other with VS1, the VS2, the VS3 pin that drive logic chip module (U5) respectively;
The drain electrode of described the 4th～the 6th field effect transistor (Q4, Q5, Q6) links to each other with VS1, the VS2, the VS3 pin that drive logic chip module (U5) respectively,
The drain electrode of described first～the 3rd field effect transistor (Q1, Q2, Q3) links to each other with direct supply interface module (U14)+24V pin respectively,
The source electrode of described the 4th～the 6th field effect transistor (Q4, Q5, Q6) links to each other with sampling resistor (U16) respectively,
VS1, the VS2, the VS3 pin that drive logic chip module (U5) link to each other with MA, MB, the MC pin of dc brushless motor interface module (17) respectively.
6. the joint module control device of a kind of modular reconfigurable as claimed in claim 1 robot, it is characterized in that: described zero utmost point bit switch module (U7) comprises zero-bit switch (S1), the first～the second utmost point bit switch (S2, S3);
The OUTPUT pin of described zero-bit switch (S1), the first～the second utmost point bit switch (S2, S3) links to each other with GPIOB3, GPIOB2, the GPIOB1 pin of dsp chip unit (U2) respectively;
The OUTPUT pin of described zero-bit switch (S1), the first～the second utmost point bit switch (S2, S3) links to each other with INPUT1, INPUT2, the INPUT3 pin of electrostatic protection chip module (U13) respectively;
The VCC pin of described zero-bit switch (S1), the first～the second utmost point bit switch (S2, S3) links to each other with the OUTPUT pin of the second voltage transitions chip module (19) in the power transfer module (U1) respectively.
7. the joint module control device of a kind of modular reconfigurable as claimed in claim 1 robot, it is characterized in that: HALL1, the HALL2 of described Hall element interface module (U8), ALL3 pin link to each other with GPIOB8, GPIOB7, the GPIOB6 pin of dsp chip unit (U2) respectively; HALL1, the HALL2 of described Hall element interface (U8), HALL3 pin link to each other with INPUT4, INPUT5, the INPUT6 pin of electrostatic protection chip module (U13) respectively; The VCC pin of described Hall element interface module (U8) links to each other with the OUTPUT pin of the second voltage transitions chip (U19) in the power conversion unit (U1);
The INPUT of described order of connection recognition interface module (U15), OUTPUT pin link to each other with GPIOA11, the GPIOA12 pin of dsp chip unit (U2) respectively; The INPUT of described order of connection recognition interface module (U15), OUTPUT pin link to each other with INPUT10, the INPUT11 pin of electrostatic protection chip module (U13) respectively.
8. the joint module control device of a kind of modular reconfigurable as claimed in claim 1 robot, it is characterized in that: the A of described photoelectric encoder interface module (U9), B pin link to each other with QEP1, the QEP2 pin of dsp chip unit (U2) respectively by resistance; The A of described photoelectric encoder interface module (U9), B pin link to each other with INPUT7, the INPUT8 pin of electrostatic protection chip module (U13) respectively; The VCC pin of described photoelectric encoder interface (U9) links to each other with the OUTPUT pin of voltage transitions chip (U19) in the power transfer module (U1);
The OUTPUT pin of described pot interface module (U12) links to each other with the ADCINB3 pin of dsp chip unit (U2); The OUTPUT pin of described pot interface module (U12) links to each other with the INPUT9 pin of electrostatic protection chip module (U13); The VCC pin of described pot interface module (U12) links to each other with the OUTPUT pin of tertiary voltage conversion chip (U20) in the power transfer module (U1);
Described detent control module (U11) comprises, the 7th opto-coupler chip (O7), the 7th field effect transistor (Q7), detent (BREAK); The OUTPUT pin of described the 7th opto-coupler chip (O7) links to each other with the grid of the 7th field effect transistor (Q7), and the drain electrode of the 7th field effect transistor (Q7) links to each other with the IN-pin of detent (BREAK), the source ground of the 7th field effect transistor (Q7); The INPUT pin of described the 7th opto-coupler chip (O7) links to each other with the GPIOB0 pin of dsp chip unit (U2); The IN+ pin of described detent (BREAK) links to each other with direct supply interface module (U14)+24V pin.
9. the joint module control device of a kind of modular reconfigurable as claimed in claim 1 robot, it is characterized in that: described simulating signal module (U10) comprises, primary amplifier (U24), secondary amplifier (U25);
The IN+ of described primary amplifier (U24), IN-pin are connected between sampling resistor and the Driving Field effect tube module (U6);
The OUTPUT pin of described primary amplifier (U24) links to each other with the IN-pin of secondary amplifier (U25);
The VCC pin of described primary amplifier (U24) links to each other with the OUTPUT pin of the second voltage transitions chip (U19) in the power transfer module (U1);
The IN+ pin of described secondary amplifier (U25) passes through resistance eutral grounding;
The OUTPUT pin of described secondary amplifier (U25) links to each other with the ADCINA3 pin of dsp chip unit (U2), and the VCC pin of described secondary amplifier (U25) links to each other with the OUTPUT pin of tertiary voltage conversion chip (U20) in the power conversion unit (U1).
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2009202882167U CN201716570U (en) | 2009-12-18 | 2009-12-18 | Modularized reconstructible robot joint module control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2009202882167U CN201716570U (en) | 2009-12-18 | 2009-12-18 | Modularized reconstructible robot joint module control device |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN201716570U true CN201716570U (en) | 2011-01-19 |
Family
ID=43462576
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2009202882167U Expired - Lifetime CN201716570U (en) | 2009-12-18 | 2009-12-18 | Modularized reconstructible robot joint module control device |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN201716570U (en) |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102248536A (en) * | 2011-06-14 | 2011-11-23 | 武汉科技大学 | Mobile mechanical arm control system used for extendable modularization |
| CN102298324A (en) * | 2011-06-21 | 2011-12-28 | 东华大学 | Cooperative intelligent accurate fault-tolerance controller and method thereof |
| CN102314690A (en) * | 2011-06-07 | 2012-01-11 | 北京邮电大学 | Method for separating and identifying kinematical parameters of mechanical arm |
| CN102103372B (en) * | 2009-12-18 | 2013-03-13 | 中国科学院沈阳自动化研究所 | Key module control system of modularization reconfigurable robot |
| CN106584452A (en) * | 2015-10-19 | 2017-04-26 | 沈阳新松机器人自动化股份有限公司 | Universal robot safety control device |
| CN109542082A (en) * | 2018-11-15 | 2019-03-29 | 中铁第四勘察设计院集团有限公司 | A kind of train water robot fault-tolerant control system and method |
| CN111923032A (en) * | 2020-10-12 | 2020-11-13 | 中国科学院沈阳自动化研究所 | Modular reconfigurable orthogonal joint chain type robot |
-
2009
- 2009-12-18 CN CN2009202882167U patent/CN201716570U/en not_active Expired - Lifetime
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102103372B (en) * | 2009-12-18 | 2013-03-13 | 中国科学院沈阳自动化研究所 | Key module control system of modularization reconfigurable robot |
| CN102314690A (en) * | 2011-06-07 | 2012-01-11 | 北京邮电大学 | Method for separating and identifying kinematical parameters of mechanical arm |
| CN102248536A (en) * | 2011-06-14 | 2011-11-23 | 武汉科技大学 | Mobile mechanical arm control system used for extendable modularization |
| CN102248536B (en) * | 2011-06-14 | 2013-07-24 | 武汉科技大学 | Mobile mechanical arm control system used for extendable modularization |
| CN102298324A (en) * | 2011-06-21 | 2011-12-28 | 东华大学 | Cooperative intelligent accurate fault-tolerance controller and method thereof |
| CN102298324B (en) * | 2011-06-21 | 2013-04-17 | 东华大学 | Cooperative intelligent accurate fault-tolerance controller and method thereof |
| CN106584452A (en) * | 2015-10-19 | 2017-04-26 | 沈阳新松机器人自动化股份有限公司 | Universal robot safety control device |
| CN106584452B (en) * | 2015-10-19 | 2019-11-12 | 沈阳新松机器人自动化股份有限公司 | Robot universal safety control device |
| CN109542082A (en) * | 2018-11-15 | 2019-03-29 | 中铁第四勘察设计院集团有限公司 | A kind of train water robot fault-tolerant control system and method |
| CN111923032A (en) * | 2020-10-12 | 2020-11-13 | 中国科学院沈阳自动化研究所 | Modular reconfigurable orthogonal joint chain type robot |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN201716570U (en) | Modularized reconstructible robot joint module control device | |
| CN102103372B (en) | Key module control system of modularization reconfigurable robot | |
| CN104795958B (en) | A kind of Brushless DC Servo System with hollow shaft motor using mechanical arm | |
| CN104391477A (en) | Drive-control integrated networked intelligent controller | |
| CN102169331B (en) | Intelligent electric operating mechanism | |
| CN103199773B (en) | Servo drive system based on bussing technique | |
| CN105364926A (en) | Multi-shaft robot driving and controlling integrated control system | |
| CN102801379A (en) | Universal full-digital direct-current motor servo driver | |
| CN203434899U (en) | High-precision servo controller used for multiple motors | |
| CN105242587A (en) | Double-drive hybrid direct-current and low-voltage intelligent servo driver circuit | |
| CN105373079A (en) | Motion controller and servo driver cooperative control system | |
| CN101045299A (en) | Independent joint control device for modularized robot based on DSP | |
| CN105490594A (en) | Double low-voltage brushless DC motor drive control system and method | |
| CN205121333U (en) | AGV on -board control system | |
| CN209497405U (en) | A kind of AGV servo motor driving control system | |
| CN203094429U (en) | Steering engine controller | |
| CN110635723A (en) | Permanent magnet synchronous motor servo system based on magnetic encoder | |
| CN106335076A (en) | Intelligent and safe type integrated service robot joint | |
| CN202677196U (en) | AGV interface board based FPGA | |
| CN111273612A (en) | Mobile robot motion controller | |
| KR20130010183A (en) | Robot system using power line communication | |
| CN102126220A (en) | Control system for six-degree-of-freedom mechanical arm of humanoid robot based on field bus | |
| CN201393196Y (en) | Drive module for controlling industrial direct current motor by using an airplane model remote controller | |
| CN206039227U (en) | Low -cost integrated servo of marine navigation radar | |
| CN205450728U (en) | Machine tools electric IO module controlling means |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| AV01 | Patent right actively abandoned |
Granted publication date: 20110119 Effective date of abandoning: 20091218 |
|
| AV01 | Patent right actively abandoned |
Granted publication date: 20110119 Effective date of abandoning: 20091218 |
|
| RGAV | Abandon patent right to avoid regrant |