CN205139614U - Imitative motion control of people robot ware based on it is embedded - Google Patents

Abstract

The utility model discloses with the aid of CPLD programmable logic control unit, constitute embedded real -time controller, especially relate to an imitative motion control of people robot ware based on it is embedded, it has ARM microprocessor and input device interfaces such as voice module, touch -sensitive screen, keyboard and mouse, input device's incoming signal is received to the ARM microprocessor input port, and voice module is used for detecting sound control command and voice broadcast, the touch -sensitive screen is as input/output cell, can the manually enter the order through the touch -sensitive screen interface, also can show imitative every articular running state of people robot, keyboard and the input unit of mouse as the ARM chip can be used to change parameter of electric machine setting, ARM microprocessor real -time processing incoming signal communicates with CPLD programmable logic control unit, and CPLD programmable logic control unit is used for address decoding to to instruct and send for a plurality of C8051 singlechips with the broadcasting formula, it converts the instruction into pulse, control stepper motor drive, and step motor driving motor rotates or stops.

Description

Based on Embedded anthropomorphic robot motion controller

Technical field

The utility model is a kind of based on Embedded anthropomorphic robot motion controller, especially a kind of embedded controller adopting ARM microprocessor (4) and uC/OS-II embedded OS is related to, for controlling multi-axle motor interlock, belong to robotics.

Background technology

Before the utility model, make a general survey of the driving both at home and abroad to multi-axle motor coordinated signals, its control mode has multiple.There are three kinds of features in external motion Controller Design direction: based on the motion controller of computer standard bus; Soft type open-type motion; The motion controller of damascene structures.The PMAC motion controller based on DSP technology of DeltaTau digital display circuit company of the U.S., this product uses the DSP560002 of Motorola to be core central processor, and technology is very ripe, and its feature is powerful, be applicable to the occasion that compound movement controls, as robot etc.But it controls to count less, increase while controlling to count, price then increases a lot, can not promote in general control occasion.

Utility model content

The purpose of this utility model overcomes above-mentioned defect exactly, provides a kind of based on Embedded anthropomorphic robot motion controller.

The technical solution of the utility model is:

A kind of based on Embedded anthropomorphic robot motion controller, this controller can control 20 axle degree of freedom interlocks, and can have processing power to the signal of scrambler and Gravity accelerometer feedback.The technical solution of the utility model is: a kind of based on Embedded anthropomorphic robot motion controller, it is characterized in that voice module, touch-screen and keyboard and mouse are connected on the speech interface of ARM microprocessor respectively, touch screen interface and keyboard and mouse interface, ARM microprocessor and CPLD complex programmable logic unit communication, and the strings of commands is transferred to CPLD complex programmable logic unit input interface, CPLD complex programmable logic unit is by strings of commands decoding, and export to single-chip microcomputer, Single-chip Controlling stepper motor driver chip, Driving Stepping Motor action, the state of stepper motor action feeds back to single-chip microcomputer by signal feedback unit, realize closed-loop control,

Voice module is that the hardware cell being core with LD3320 chip realizes speech identifying function.The data line of LD3320, address wire adopt parallel mode directly to connect with ARM microprocessor, all adopt 1k Europe pull-up resistor, and it is data segment or address field that A0 is used for judgement; Control signal RDB, WRB, CSB, reset signal RSTB and interruption return signal INTB connects with ARM microprocessor, adopts 10k ohm pull-up resistor, backup system steady operation;

ARM microprocessor selects the 32 bit processor STM32F104ZET6 chips based on ARMCortex-M3 kernel of ST company as master controller chip.Embedded OS uC/OS-II is adopted to realize unified task scheduling and peripherals administration;

Complex programmable logic unit selects EPM3256ATI144 series CPLD chip as address decoding and data transmission.CPLD chip adopts four-wire system to be connected with single-chip microcomputer, and wherein two lines are for address selection zone bit and single-chip microcomputer enable signal, other two lines as the reception of serial ports and transmission, for transmitting data.CPLD chip adopts broadcast type to control, and ensures the consistance of multiple motor movement, can control 20 spindle motor interlocks;

Signal feedback unit is made up of absolute type encoder and Gravity accelerometer, by the tilt angle feed-back of the rotating speed of stepper motor (8) and stepper motor place plane to single-chip microcomputer, the data of single-chip microcomputer process encoder feedback, the rotating speed of real-time control motor also compensates the angle of motor, send the data that Gravity accelerometer feeds back to ARM microprocessor simultaneously, by ARM microprocessor according to D-H coordinate computation, forward kinematics analysis and inverse motion analysis are carried out to each joint in Humanoid Robot Based on Walking, and the dangerous point existed in pose during Humanoid Robot Based on Walking is set up a storehouse, premised on the situation meeting maximum stable nargin, the motor in the joint that modification stability nargin is minimum, make Humanoid Robot Based on Walking more stable.

Advantage of the present utility model and effect be that peripheral circuit is simple, cost is low, can realize speed to multiaxis stepper motor and positioning control by the man-machine interaction of hommization.The utility model utilizes voice module, gathers voice command, also can use touch-screen manual input commands, utilizes mouse and keyboard interface, external access of mouse and keyboard, and assist command inputs, easy to use.Control chip adopts the modules of uC/OS-II real time operating system to control system to dispatch, and the abundant control functionality utilizing uC/GUI to provide, provide succinct, friendly human-computer interaction interface, the running status of each joint motor of anthropomorphic robot can be shown.

Other advantage of the present utility model and effect will go on to say below.

Accompanying drawing explanation

Fig. 1 is the structural principle block diagram of the utility model controller;

Fig. 2 is that ARM and CPLD communicates I/O distribution diagram;

Fig. 3 is physical circuit schematic diagram of the present utility model;

Fig. 4 is voice acquisition module of the present utility model;

Fig. 5 is single-chip microcomputer of the present utility model (6) peripheral circuit;

Fig. 6 is motor-drive circuit of the present utility model;

Fig. 7 is the power circuit of the utility model controller;

Embodiment

1.ARM microprocessor is a kind of high-end microcontroller designed based on essence solution instruction set computer (RISC) principle, instruction set is simpler than complex instruction set computer (CISC) many with relevant decoding mechanism, the high instruction throughput of such simple implementation, outstanding interrupt response, the processor macroelement of high performance-price ratio, both can operation system, can do again and control in real time to use, compared with DSP, DSP be mainly used for calculate data-signal, such as be encrypted deciphering, modulation /demodulation etc., the main advantage of DSP is powerful data-handling capacity and higher travelling speed, and ARM microprocessor has stronger transaction management function, may be used for running application, its advantage is mainly reflected in control aspect, be more suitable for Industry Control, motor driving etc., in addition, ARM microprocessor framework is towards low budget Market Design, cost is more much lower than DSP.

2.CPLD CPLD is used for compiling of instruction and addressing, and major function is for ARM microprocessor saves interface, reduces the time taken when ARM microprocessor sends instruction, for ARM microprocessor computing pose algorithm, save time, make system response time fast, control more accurate.

3. as shown in Figure 1: voice module, touch-screen, keyboard and mouse connect voice module interface, touch screen interface, the mouse-keyboard interface of ARM microprocessor respectively, ARM microprocessor adopts STM32F104 family chip, its dominant frequency is up to 72MHz, internal high-speed memories (flash memory of 512KB and the SRAM of 64KB), there is the instruction execution speed of 1.25Mips/MHz, for the loading of complicated algorithm provides hardware foundation, it has 112 general input/output ports, and the utility model make use of 38 GPIO wherein and peripheral components transmitting data in parallel just.

4. as shown in Figure 2: ARM microprocessor is connected by 22 interfaces with CPLD, wherein two is Serial Port Line, remaining 20 is the zone bit of C8051 address, CPLD chip is directly connected with C8051 by 4 interfaces, wherein two is RX, TX Serial Port Line, all the other two is CE, CS is that the enable signal of C8051 and sheet select zone bit, CPLD can control 20 degree of freedom interlocks, each degree of freedom takies 4 interfaces, 20 degree of freedom take CPLD chip 80 I/O mouths altogether, CPLD chip and ARM communication take 22 I/O mouths, CPLD chip consumes 102 I/O mouths altogether, so chip of the present utility model is the EPM3256ATI144 family chip selecting CPLD chip.

5. as shown in Figure 3: P1 unit piece is the JTAG download interface of standard 10 pin, wherein pin 1 is test clock input TCK, be connected with the PA14 pin of micro-chip processor, pin 3 is that test data exports TDO, be connected with the PB3 pin of micro-chip processor, pin 4 is reference voltage inputs, identical with chip operating voltage 3.3V, pin 5 is that test pattern selects TMS, be connected with the PA13 pin of micro-chip processor, pin 6 is test reset nRST, be connected with the nRST pin of micro-chip processor, pin 9 is test data input TDI, be connected with the PA15 pin of micro-chip processor, pin 10 is GND.

6. voice module adopts LD3320 chip to be that the hardware cell of core realizes speech identifying function.

7. as shown in Figure 4: the data line of LD3320, address wire (P0 ~ P7) adopt parallel mode directly to connect with STM32F104ZET6 chip GPIO (PB0 ~ PB9), all adopt 1k Europe pull-up resistor, wherein PB3 interface is connected with 10 pin jtag test output pin TDO of standard, PB4 is connected with jtag test reset pin, and it is data segment or address field that A0 is used for judgement; Control signal RDB, WRB, CSB, reset signal RSTB, interruption return signal INTB and clock signal clk connect with STM32F104ZET6 chip GPIO (PD0 ~ PD5) respectively, adopt 10k ohm pull-up resistor, backup system steady operation.

8. touch-screen selects Delta A series HMIDOP, touch screen interface is connected with GPIO (PA9, PA10) serial ports of ARM microprocessor, by writing touch screen program, the parameter of directly change motor on man-machine interface can be realized, as rotate angle, startup and stopping time acceleration-deceleration, on display interface, set up the linkage assembly of 19 degree of freedom, each degree of freedom represents the motor in a joint, when motor is when rotating, display interface also can be seen the state of motion.

9. stepper motor driving circuit is made up of C8051F410 series monolithic and THB6064H driving chip.

10 as shown in Figure 5, J4 unit is four-wire interface, download for Single Chip Microcomputer (SCM) program, single-chip processor i/o (P0.4 ~ P0.7) port is connected with CPLD chip, for transfer instruction, single-chip microcomputer enable signal CE is connected with the P0.7 of single-chip microcomputer, single-chip microcomputer chip selection signal CS is connected with the P0.6 of single-chip microcomputer, microcontroller serial port receiving end RX is connected with the P0.5 of single-chip microcomputer, microcontroller serial port transmitting terminal TX is connected with the P0.4 of single-chip microcomputer, the ADC subsystem of C8051F410 single-chip microcomputer is integrated with the Multipexer selector switch (AMUX0) of 27 passages and 12 successive approximation register type ADC of a 200ksps, track and hold circuit is integrated with in ADC, windows detector able to programme and hardware totalizer, in sheet, SilionLabs two wires (C2) development interface allows to use the product MCU be arranged in final application system to carry out non-intrusion type (not taking resource in sheet), at full speed, on-line system is debugged, the utility model adopts C2 to carry out download debugging Single Chip Microcomputer (SCM) program, P0.3, P0.2, P0.1 respectively with the M1 of driving chip, M2, M3 connects, P0.0 controls to drive reference voltage Vref, P1.7, P1.6, P1.5 respectively with the Enable of driving chip, CW/CCW, CLK connects, P1.2, P1.3, P1.4 is feedback signal interface, can input acceleration sensor feedback signal and encoder feedback signal.

11. select THB6064H as the driving chip of stepper motor, the peripheral circuit of driving chip.

12. as shown in Figure 6, THB6064H chip has 7 and controls pin, 4 output pins, M1, M2, M3 pin is segmentation number selecting side, Vref is reference voltage input terminal, when Vref is noble potential, make NPN type triode Q2 conducting, resistance R5 is through Q2 ground connection, now, PNP type triode Q1 conducting, the collector and emitter of Q1 pipe is by resistance R2, diode D2 short circuit, the voltage of Vref is raised, Vref ≈ (5-1)/(4.7+1) V, when Vref is electronegative potential, NPN type triode Q2 is ended, resistance R5 becomes noble potential, now, PNP type triode Q1 ends, resistance R2, diode D2 participates in bleeder circuit, the current potential of Vref is reduced, Vref ≈ (5-0.7)/(10+4.7+1) V, by regulating the high electronegative potential of Vref pin, the current value of driving chip output pin can be realized, thus electric current when making stepper motor rotate is large, during stopping, certain band-type brake electric current also used by stepper motor, the output pin OUT1A of driving chip, OUT2A, OUT1B, OUT2B is connected with four lines of two-phase hybrid stepping motor respectively, Enable is the Enable Pin of driving chip, as Enable=0, all outputs of driving chip are zero, as Enable=1, driving chip normally works, CW/CCW is stepper motor rotation direction control end, when CW/CCW is low level, motor rotates forward, when CW/CCW is high level, motor reversal, CLK is pulse input end, by regulating the dutycycle of input pulse, the rotating speed of stepper motor can be regulated, CLK is the square wave of-0.2 ~ VDD, pulsed frequency is up to 200KHz, pulse width is minimum is 2.3us.

Claims (5)

1. based on Embedded anthropomorphic robot motion controller, it is characterized in that voice module, touch-screen and keyboard and mouse are connected on the speech interface of ARM microprocessor respectively, touch screen interface and keyboard and mouse interface, ARM microprocessor and CPLD complex programmable logic unit communication, and the strings of commands is transferred to CPLD input interface, CPLD complex programmable logic unit is by strings of commands decoding, and export to single-chip microcomputer, Single-chip Controlling driving chip, Driving Stepping Motor action, state and the pose signal of stepper motor action feed back to single-chip microcomputer by signal feedback unit, realize closed-loop control.

2. according to claim 1 based on Embedded anthropomorphic robot motion controller, it is characterized in that voice module is that the hardware cell being core with LD3320 chip realizes speech identifying function, the data line of LD3320, address wire adopt parallel mode directly to connect with ARM microprocessor, all adopt 1k Europe pull-up resistor, it is data segment or address field that A0 is used for judgement; Control signal RDB, WRB, CSB, reset signal RSTB and interruption return signal INTB connects with ARM microprocessor, adopts 10k ohm pull-up resistor, backup system steady operation.

3. according to claim 1 based on Embedded anthropomorphic robot motion controller, it is characterized in that ARM microprocessor selects the 32 bit processor STM32F104ZET6 chips based on ARMCortex-M3 kernel of ST company as master controller chip, adopt embedded OS uC/OS-II to realize unified task scheduling and peripherals administration.

4. according to claim 1 based on Embedded anthropomorphic robot motion controller, it is characterized in that complex programmable logic unit selects EPM3256ATI144 series CPLD chip as address decoding and data transmission, CPLD chip adopts four-wire system to be connected with single-chip microcomputer, wherein two lines are used for address selection zone bit and single-chip microcomputer enable signal, other two lines are as the reception of serial ports and transmission, for transmitting data, CPLD chip adopts broadcast type to control, ensure the consistance of multiple motor movement, 20 spindle motor interlocks can be controlled.

5. according to claim 1 based on Embedded anthropomorphic robot motion controller, it is characterized in that signal feedback unit is made up of absolute type encoder and Gravity accelerometer, by the tilt angle feed-back of the rotating speed of stepper motor and stepper motor place plane to single-chip microcomputer, the data of single-chip microcomputer process encoder feedback, the rotating speed of real-time control motor also compensates the angle of motor, send the data that Gravity accelerometer feeds back to ARM microprocessor simultaneously, by ARM microprocessor according to D-H coordinate computation, forward kinematics analysis and inverse motion analysis are carried out to each joint in Humanoid Robot Based on Walking, and the dangerous point existed in pose during Humanoid Robot Based on Walking is set up a storehouse, premised on the situation meeting maximum stable nargin, the motor in the joint that modification stability nargin is minimum, make Humanoid Robot Based on Walking more stable.