CN103753534B - A kind of Movement Controller of Mobile Robot and control method thereof - Google Patents

A kind of Movement Controller of Mobile Robot and control method thereof Download PDF

Info

Publication number
CN103753534B
CN103753534B CN201310682904.2A CN201310682904A CN103753534B CN 103753534 B CN103753534 B CN 103753534B CN 201310682904 A CN201310682904 A CN 201310682904A CN 103753534 B CN103753534 B CN 103753534B
Authority
CN
China
Prior art keywords
module
distance
industrial computer
remote controller
acceleration
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.)
Active
Application number
CN201310682904.2A
Other languages
Chinese (zh)
Other versions
CN103753534A (en
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.)
State Grid Intelligent Technology Co Ltd
Original Assignee
State Grid Corp of China SGCC
Electric Power Research Institute of State Grid Shandong Electric Power Co Ltd
Shandong Luneng Intelligence Technology 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 State Grid Corp of China SGCC, Electric Power Research Institute of State Grid Shandong Electric Power Co Ltd, Shandong Luneng Intelligence Technology Co Ltd filed Critical State Grid Corp of China SGCC
Priority to CN201310682904.2A priority Critical patent/CN103753534B/en
Publication of CN103753534A publication Critical patent/CN103753534A/en
Application granted granted Critical
Publication of CN103753534B publication Critical patent/CN103753534B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

The invention discloses a kind of Movement Controller of Mobile Robot and control method, comprise remote controller, radio receiving transmitting module, industrial computer, receiver, sensor, wireless transmission system of sensor, proportioning valve, switch valve; Gather the control information of telecontrol panel by remote controller collection plate, send to main industrial computer with instruction type, industrial computer gathers the information of each joint absolute value encoder simultaneously, after main industrial computer carries out Kinematic Algorithms processing, control instruction is sent to receiver, complete the motion control of mobile assembly robot. Utilization of the present invention is connected in its end specific purpose tool, adopting principal and subordinate to add autonomous control mode replaces people's arm to complete the high automobile assembling task of frequency, can alleviate operating personnel's labour intensity on the one hand, on the other hand also for operating personnel's safety provides the mobile assembly robot controller and the control method that ensure.

Description

A kind of Movement Controller of Mobile Robot and control method thereof
Technical field
The present invention relates to a kind of Robotics, especially a kind of Movement Controller of Mobile Robot and control method thereof.
Background technology
Assembly robot is the nucleus equipment of flexible automation assembly system, by robot manipulator, controller, end effectorForm with sensor-based system. Wherein the structure type of manipulator has flapping articulation type, cartesian co-ordinate type, joint type and circular cylindrical coordinateType etc.; General many CPU or the multi-level computer system of adopting of controller, realizes motion control and movement programming; End effector isAdapt to different assembling objects and be designed to various paws and wrist etc.; Sensor-based system obtains again put together machines human and environment and dressInteractional information between pairing resembles. It is PUMA machine that conventional assembly robot mainly contains general programmable assembly manipulation handPeople (come across the earliest 1978, the ancestral of industrial robot is begun) and plane doublejointed humanoid robot are SCARA robot two kindsType. Compared with general industry robot, assembly robot has that precision is high, compliance good, working range is little, can be with otherSystem such as supports the use at the feature, is mainly used in the manufacturing of various electrical equipment.
Current assembly robot is all solid mechanical arm, mechanical arm is arranged on mobile robot, therefore with fixing machineryArm is compared, and has the flexibility of larger working space and Geng Gao, can obtain applying more widely. But mobile assembly machineDevice people is more complicated than the structure of fixing operation arm, so also more difficult to operations such as the planning of its end, controls.
Summary of the invention
The object of the invention is for overcoming above-mentioned the deficiencies in the prior art, a kind of mobile assembly robot controller is provided, utilize connectionBe connected on its end specific purpose tool, the arm that adopts principal and subordinate to add autonomous control mode replacement people completes the assembling work of automobile, on the one handCan alleviate operating personnel's labour intensity, on the other hand also for operating personnel's safety provides the mobile assembly robot control ensureingDevice processed and control method.
For achieving the above object, the present invention adopts following technical proposals.
A kind of Movement Controller of Mobile Robot, comprises remote controller, radio receiving transmitting module, industrial computer, receiver, sensor, sensingDevice wireless transmitting system, proportioning valve, switch valve.
Described remote controller is communicated by letter with industrial computer by wireless module, and industrial computer connects receiver, receiver and proportioning valve, switch valveConnect, sensor is located in robot, and connects industrial computer by wireless transmission system of sensor, the instruction of described remote controller,Be handed down to industrial computer by wireless module, industrial computer passes through the instruction of receiver downloading speed, switch drive instruction to robot; InstituteState remote controller comprise analogue collection module, digital data acquisition module, magnetic lotus root isolation module I, magnetic lotus root isolation module II, magnetic lotus root everyFrom module ii I, reset circuit, jtag circuit, microcontroller circuit, serial port drive circuit. Analogue collection module, digital quantityAcquisition module is connected with microprocessor by magnetic lotus root isolation module I, magnetic lotus root isolation module II respectively, microprocessor, magnetic lotus root isolation modePiece III, serial port drive circuit connect successively, and reset circuit, jtag circuit are connected with microprocessor respectively, analogue collection moduleThe data that gather remote controller simulation rocking bar, digital data acquisition module gathers the data of locking button, Self-resetting button, and through micro-After processor is processed, through serial port drive circuit, wireless module, send to industrial computer. Described remote controller can be with 7 mouldsIntend rocking bar, i.e. engine start and stop, throttle size, a key reduction, teaching, reproduction, world coordinate system motion button, instrument controlSystem.
Described microprocessor adopts 32 TMS320F2812DSP chips, and dominant frequency can reach 150MHz.
Described magnetic lotus root isolation module is selected the ADuM1400/1/2 four-way digital isolator of ADI company. Two ends operating voltage2.7V~5.5V, supports low voltage operating and can realize level conversion.
Described robot is provided with mechanical arm, and described mechanical arm is 5DOF hydraulic machinery arm; Position sensor measurement mechanical armThe angle of each axle or length; Described mechanical arm can be by hydraulic-driven, and hydraulic power source is provided with magnetic valve and is used for starting, stopping startingThe size of machine, control throttle.
Car body move control possess advance, retreat, the function such as speed governing, left and right turn security monitoring.
Elevating mechanism motion control possesses the functions such as simple joint control, simple joint position feedback and security monitoring.
Engine and power supply power monitoring module possess the prison of the controls such as engine start and stop, speed governing and engine condition and supply voltageDepending on etc. function.
Described industrial computer adopts the small-sized industrial computer of ARK-5260, and dominant frequency 1.66GHz, with 2 network interfaces, supports 4 tunnels232/422/485 interface, carries 2 road pci expansion slots, 12-24V DC power supply.
Described receiver is exported 7 road analog signalses, voltage range 3~9V, and 6V represents meta; Export 3 way switch amount signals,Drive current 10A, 12V.
Described angle displacement sensor adopts BE1822S58,13 of overall accuracy individual pens, and the free agreement output of RS485, without looking forZero, possess starting point and demarcate and set function.
Described wireless transport module adopts SZ02-ZIGBEE wireless communication module, have that communication distance is far away, antijamming capability strong,The advantages such as networking flexibility and characteristic, can realize a point-to-multipoint and multi-multipoint between the transparent transmission of equipment room data.
Described hydraulic proportion valve adopts Danfoss valve, supply voltage 12V, and input control signal 3-9V, 6V is zero-bit.
The invention also discloses a kind of mobile robot control method, comprise the steps:
Input robot motion's initial point P0(x0,y0,z0) and terminal Pf(xf,yf,zf) movement velocity Pv, Acceleration and deceleration time TaWith interpolation cycle Tc, running time T;
The method for solving of the definite and interpolated point of basic parameter; Carrying out, before moving interpolation, determining PvWhether meeting acceleration and deceleration wantsAsk; Method is as follows:
By P0(x0,y0,z0) and Pf(xf,yf,zf) obtain actual motion distance Pd=|P0Pf|; By PvAnd TaCalculate accelerating and decelerating partRequired separation distanceIf Cd≥Pd, actual motion speedOtherwise Cv=Pv; By time TaWith slottingMend time TcDraw and accelerate step number Sa; By P0(x0,y0,z0) and Pf(xf,yf,zf), can obtain space the parametric equation of the straight line
x = k ( x f - x 0 ) + x 0 y = k ( y f - y 0 ) + y 0 z = k ( z f - z 0 ) + z 0 Wherein k is scale factor, 0≤k≤1 (1)
Therefore by formula (1), can obtain each interpolated point Pi(xi,yi,zi) to P0Distance be
C Sd ( i ) = | P i P 0 | = ( x i - x 0 ) 2 + ( y i - y 0 ) 2 + ( z i - z 0 ) 2 = k P d (CSd(i)Represent Pi(xi,yi,zi) to P0Distance,Pd=|P0Pf|)(2)
I is the step number of each interpolated point, 0 withBetween all positive integers;
Making n interpolation section move distance is Sd(n), n=1 ..., i, invocation point PiTo P0Distance
C Sd ( i ) = Σ n = 1 i S d ( n ) = C Sd ( i - 1 ) + S d ( i ) , CSd(i-1)Represent Pi-1(xi-1,yi-1,zi-1) to P0Distance,
Sd(i)I interpolation section move distance, therefore it is as follows to obtain the computing formula of each interpolated point scale factor k by formula (1) and (2):
k = C Sd ( i ) P d = Σ n = 1 i S d ( n ) P d = C Sd ( i - 1 ) + S d ( i ) P d Wherein k is scale factor, 0≤k≤1 (3)
Obtain k by formula (3), and obtain interpolated point rectangular co-ordinate.
Described accelerated motion section move distance Sd(i)The method of determining is as follows:
By actual motion speed CvWith Acceleration and deceleration time TaTry to achieve accelerationTherefore an acceleration Duan Shang i interpolated pointSpeed Scv(i)=iTcA, obtains
S d ( i ) = 1 2 ( S cv ( i ) + S cv ( i - 1 ) ) · T c = 1 2 ( 2 i - 1 ) a T c 2 - - - ( 4 )
Scv(i-1)Represent the speed of i-1 interpolated point.
Described uniform motion section move distance Sd(i)The method of determining is as follows:
The at the uniform velocity each interpolation section move distance S of sectiond(i)=Cv·Tc
Described retarded motion section move distance Sd(i)The method of determining is as follows:
Through after i-1 interpolated point above, obtain last distance Ld(i)=Pd-CSd(i-1), therefore can obtain braking section accelerationThe speed S of a deceleration Duan Shang m interpolated pointcv(m)=Cv+mTcA, can obtain
S d ( m ) = 1 2 ( S cv ( m ) + S cv ( m - 1 ) ) · T c = 1 2 [ 2 C v + a · ( 2 m - 1 ) · T c ] - - - ( 5 )
The operation principle of mobile assembly robot controller of the present invention is: gather the control of telecontrol panel by remote controller collection plateInformation processed, sends to main industrial computer with instruction type, and industrial computer gathers the information of each joint absolute value encoder simultaneously, through main workControl machine carries out, after Kinematic Algorithms processing, control instruction being sent to receiver, completes the motion control of mobile assembly robot.
Adopt such scheme, the present invention has the following advantages, and the one, the mobile assembly robot control system of designed, designed is through experimentChecking, replaces people's the arm higher automobile assembling task of frequency that fulfils assignment; The 2nd, embedded mechanical arm is little from heavy and light, size,Control system is low in energy consumption and size is little, is applicable to the application needs of mobile assembly robot. The 3rd, mobile assembly robot can be realizedComplicated a key reduction, teaching reproduction, linear interpolation motion; The 4th, system adopts modularized design, has opening, readableProperty, extensibility, maintainability, to continue exploitation. The 5th, master controller adopts main industrial computer, and main industrial computer is realized motionLearn positive and negative solution, interpolation algorithm, can realize complicated motion control, processing speed is fast. The 6th, controller band position sensorInterface, potentiometer interface, multiple functional, positional precision is high.
Brief description of the drawings
Fig. 1 is structural principle general diagram of the present invention;
Fig. 2 is remote controller collection plate theory diagram of the present invention;
Fig. 3 is vehicle-mounted mechanical arm configuration figure of the present invention;
Fig. 4 is telecontrol panel figure of the present invention;
Fig. 5 is the present invention one key reduction principle figure;
Fig. 6 is world coordinate system trajectory planning flow chart of the present invention;
Wherein, 1, remote controller; 2, wireless sending module; 3, wireless receiving module; 4, industrial computer; 5, receiver; 6,Position sensor; 7,485 buses; 8, proportioning valve; 9, switch valve; 10, analogue collection module; 11, digital data acquisitionModule; 12, magnetic lotus root isolation module I; 13, magnetic lotus root isolation module II; 14, magnetic lotus root isolation module III; 15, reset circuit; 16,Jtag circuit; 17, microprocessor; 18, serial port drive circuit; 19, crystal oscillating circuit.
Detailed description of the invention
Below in conjunction with drawings and Examples, the present invention is further described.
Referring to Fig. 1, a kind of mobile assembly robot controller, comprises remote controller 1, wireless sending module 2, wireless receiving module3, industrial computer 4, receiver 5, position sensor 6,485 buses 7, proportioning valve 8, switch valve 9.
The output of remote controller 1 control panel connects the input of data acquisition board, and the output of data acquisition board connects wireless sending module 2;The output of wireless receiving module 3 connects the input of industrial computer 4 by serial ports, the output of industrial computer 4 connects receiver 5 by serial portsInput, the output of receiver 5 connects proportioning valve 8 and switch valve 9; Position sensor 6 connects industrial computer 4 by 485 buses 7Input. The instruction of described remote controller 1, is handed down to industrial computer 4, industry control by wireless sending module 2 and wireless receiving module 3Machine 4 passes through receiver 5 downloading speed instructions, switch drive instruction to hydraulic system.
Referring to Fig. 2, described remote controller 1 collection plate comprise analogue collection module 10, digital data acquisition module 11, magnetic lotus root everyFrom module I 12, magnetic lotus root isolation module II13, magnetic lotus root isolation module III14, reset circuit 15, jtag circuit 16, microprocessor17, serial port drive circuit 18, crystal oscillating circuit 19. Analogue collection module 10 gathers the data of 7 tunnel simulation rocking bars, digital quantityAcquisition module 11 gathers the data of locking button, Self-resetting button, and after microprocessor 17 is processed, through serial port driveCircuit 18, wireless sending module 2, send to wireless receiving module 3.
Referring to Fig. 3, described mechanical arm is 5DOF, and frame for movement comprises pedestal, and support arm, support arm are installed on pedestalUpper end is shoulder joint, and forearm is arranged in shoulder joint, and the front end of forearm is connected with platform. Platform comprises platform pitch axis and platformRotating shaft.
Referring to Fig. 4, telecontrol panel schematic diagram, simulation rocking bar comprises 7, controls revolver front and back, right front and back, the large arm left side of taking turnsRight, large arm pitching, forearm are flexible, platform pitching, platform left and right; Locking button comprises instrument, selection, XYZ world coordinatesThe control of system, throttle size; Comprise the control of reset, engine start and stop, teaching, reproduction, startup from recovery button; InstructionLamp comprises power supply, radio communication, alarm lamp.
Referring to Fig. 5, mobile assembly robot is in the time of automatic motion mode, automatic according to the motion control program writing in advanceCirculation is carried out, until press the Stop button on control panel.
Referring to Fig. 6, the present embodiment adopts the mode of space line interpolation to move, and can be divided into the following steps and complete:
Input robot motion's initial point P0(x0,y0,z0) and terminal Pf(xf,yf,zf) (f is the abbreviation of final) movement velocity Pv, Acceleration and deceleration time TaWith interpolation cycle Tc, running time T;
The method for solving of the definite and interpolated point of basic parameter. Because the motion of robot space line needs through acceleration and deceleration and at the uniform velocityMotor segment, therefore carrying out, before moving interpolation, should determining PvWhether meet acceleration and deceleration requirement. Method is as follows:
By P0(x0,y0,z0) and Pf(xf,yf,zf) obtain actual motion distance Pd=|P0Pf|; By PvAnd TaCan calculate acceleration and decelerationSection required separation distanceIf Cd≥Pd, actual motion speedOtherwise Cv=Pv; By time TaWithInterpolation time TcDraw and accelerate step number Sa. By P0(x0,y0,z0) and Pf(xf,yf,zf), can obtain space the parametric equation of the straight line
x = k ( x f - x 0 ) + x 0 y = k ( y f - y 0 ) + y 0 z = k ( z f - z 0 ) + z 0 Wherein k is scale factor (0≤k≤1) (1)
Therefore by formula (1), can obtain each interpolated point Pi(xi,yi,zi) (step number that i is each interpolated point, 0 withBetween all just wholeNumber) to P0Distance be
C Sd ( i ) = | P i P 0 | = ( x i - x 0 ) 2 + ( y i - y 0 ) 2 + ( z i - z 0 ) 2 = k P d (CSd(i)Represent Pi(xi,yi,zi) to P0Distance,Pd=|P0Pf|)(2)
Making n interpolation section move distance is Sd(n)(n=1 ..., i) (n is all positive integers of 1 to i), (step that i is each interpolated pointNumber, 0 withBetween all positive integers) can invocation point PiTo P0Distance(CSd(i-1)TableShow Pi-1(xi-1,yi-1,zi-1) to P0Distance, Sd(i)I interpolation section move distance), therefore obtain each interpolated point ratio by formula (1) and (2)The computing formula of example factor k is as follows:
k = C Sd ( i ) P d = Σ n = 1 i S d ( n ) P d = C Sd ( i - 1 ) + S d ( i ) P d Wherein k is scale factor (0≤k≤1) (3)
Just can obtain k by formula (3), and obtain interpolated point rectangular co-ordinate. Therefore space line interpolation algorithm key is to determine each interpolationSection move distance Sd(i). Introduce each section of motion below and ask for Sd(i)Method:
Accelerated motion section. Because the robot accelerating sections of the present invention's design is uniformly accelerated motion, therefore by actual motion speed CvWith addDeceleration time TaTry to achieve acceleration(unit is m/s^2), the therefore speed of an acceleration Duan Shang i interpolated pointScv(i)=iTcA, can obtain
S d ( i ) = 1 2 ( S cv ( i ) + S cv ( i - 1 ) ) · T c = 1 2 ( 2 i - 1 ) a T c 2 (Scv(i-1)Represent the speed of i-1 interpolated point) (4)
Uniform motion section. Because the robot of the present invention's design requires necessary process braking section, and interpolation operation is " calculation limit, limitWalk ", therefore carry out before uniform motion section starts, must calculating last distance and can meeting system slowdown requirement at every turn. At the uniform velocity section is each insertsMend section move distance Sd(i)=Cv·Tc
Retarded motion section. Owing to asking for acceleration step number SaShi Jinhang rounds calculating, therefore the simple section of will speed up accelerationAfter negate, plan accelerating sections, can introduce like this error, therefore braking section acceleration should recalculate. Through i-1 interpolated point aboveAfter, can obtain last distance Ld(i)=Pd-CSd(i-1), therefore can obtain braking section accelerationDeceleration Duan Shang mThe speed S of individual interpolated pointcv(m)=Cv+mTcA, can obtain
S d ( m ) = 1 2 ( S cv ( m ) + S cv ( m - 1 ) ) · T c = 1 2 [ 2 C v + a · ( 2 m - 1 ) · T c ] - - - ( 5 )
By reference to the accompanying drawings the specific embodiment of the present invention is described although above-mentioned, not the limit to protection domain of the present inventionSystem, one of ordinary skill in the art should be understood that on the basis of technical scheme of the present invention, those skilled in the art do not need to payGo out various amendments that creative work can make or distortion still in protection scope of the present invention.

Claims (5)

1. a Movement Controller of Mobile Robot, is characterized in that, comprise remote controller, radio receiving transmitting module, industrial computer, receiver,Sensor, wireless transmission system of sensor, proportioning valve, switch valve; Described remote controller is logical by radio receiving transmitting module and industrial computerLetter, industrial computer connects receiver, and receiver is connected with proportioning valve, switch valve, and sensor is located in robot, and passes through sensingDevice wireless transmitting system connects industrial computer, and the instruction of described remote controller, is handed down to industrial computer by radio receiving transmitting module, industrial computerBy the instruction of receiver downloading speed, switch drive instruction to robot; Described remote controller comprises analogue collection module, numeralAmount acquisition module, magnetic lotus root isolation module I, magnetic lotus root isolation module II, magnetic lotus root isolation module III, reset circuit, jtag circuit, micro-Processor circuit, serial port drive circuit; Analogue collection module, digital data acquisition module are respectively by magnetic lotus root isolation module I, magneticLotus root isolation module II is connected with microprocessor, and microprocessor, magnetic lotus root isolation module III, serial port drive circuit connect successively, resetsCircuit, jtag circuit are connected with microprocessor respectively, and analogue collection module gathers the data of remote controller simulation rocking bar, digital quantityAcquisition module gathers the data of locking button, Self-resetting button, and after microprocessor processes, process serial port drive circuit,Radio receiving transmitting module, sends to industrial computer.
2. a mobile robot control method with Movement Controller of Mobile Robot as claimed in claim 1, is characterized in that,Comprise the steps:
Input robot motion's initial point P0(x0,y0,z0) and terminal Pf(xf,yf,zf) movement velocity Pv, Acceleration and deceleration time TaWith interpolation cycle Tc, running time T;
The method for solving of the definite and interpolated point of basic parameter; Carrying out, before moving interpolation, determining PvWhether meeting acceleration and deceleration wantsAsk; Method is as follows:
By P0(x0,y0,z0) and Pf(xf,yf,zf) obtain actual motion distance Pd=|P0Pf|; By PvAnd TaCalculate accelerating and decelerating partRequired separation distanceIf Cd≥Pd, actual motion speedOtherwise Cv=Pv; By time TaWith slottingMend time TcDraw and accelerate step number Sa; By P0(x0,y0,z0) and Pf(xf,yf,zf), obtain space the parametric equation of the straight line
x = k ( x f - x 0 ) + x 0 y = k ( y f - y 0 ) + y 0 z = k ( z f - z 0 ) + z 0 Wherein k is scale factor, 0≤k≤1 (1)
Therefore by formula (1), obtain each interpolated point Pi(xi,yi,zi) to P0Distance be
C S d ( i ) = | P i P 0 | = ( x i - x 0 ) 2 + ( y i - y 0 ) 2 + ( z i - z 0 ) 2 = kP d , CSd(i)Represent Pi(xi,yi,zi) to P0Distance,Pd=|P0Pf|,(2)
I is the step number of each interpolated point, 0 withBetween all positive integers;
Making n interpolation section move distance is Sd(n), n=1 ..., i, invocation point PiTo P0Distance
CSd(i-1)Represent Pi-1(xi-1,yi-1,zi-1) to P0Distance,
Sd(i)I interpolation section move distance, therefore it is as follows to obtain the computing formula of each interpolated point scale factor k by formula (1) and (2):
Wherein k is scale factor, 0≤k≤1, (3)
Obtain k by formula (3), and obtain interpolated point rectangular co-ordinate.
3. mobile robot control method as claimed in claim 2, is characterized in that, accelerated motion section move distance Sd(i)DetermineMethod is as follows:
By actual motion speed CvWith Acceleration and deceleration time TaTry to achieve accelerationTherefore an acceleration Duan Shang i interpolated pointSpeed Scv(i)=iTcA, obtains
S d ( i ) = 1 2 ( S c v ( i ) + S c v ( i - 1 ) ) · T c = 1 2 ( 2 i - 1 ) aT c 2 - - - ( 4 )
Scv(i-1)Represent the speed of i-1 interpolated point.
4. mobile robot control method as claimed in claim 2, is characterized in that, uniform motion section move distance Sd(i)DetermineMethod is as follows:
The at the uniform velocity each interpolation section move distance S of sectiond(i)=Cv·Tc
5. mobile robot control method as claimed in claim 2, is characterized in that, retarded motion section move distance Sd(i)DetermineMethod is as follows:
Through after i-1 interpolated point above, obtain last distance Ld(i)=Pd-CSd(i-1), obtain braking section accelerationThe speed S of a deceleration Duan Shang m interpolated pointcv(m)=Cv+mTcA, obtains
S d ( m ) = 1 2 ( S c v ( m ) + S c v ( m - 1 ) ) · T c = 1 2 [ 2 C v + a · ( 2 m - 1 ) · T c ] - - - ( 5 ) .
CN201310682904.2A 2013-12-13 2013-12-13 A kind of Movement Controller of Mobile Robot and control method thereof Active CN103753534B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310682904.2A CN103753534B (en) 2013-12-13 2013-12-13 A kind of Movement Controller of Mobile Robot and control method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310682904.2A CN103753534B (en) 2013-12-13 2013-12-13 A kind of Movement Controller of Mobile Robot and control method thereof

Publications (2)

Publication Number Publication Date
CN103753534A CN103753534A (en) 2014-04-30
CN103753534B true CN103753534B (en) 2016-05-04

Family

ID=50520929

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310682904.2A Active CN103753534B (en) 2013-12-13 2013-12-13 A kind of Movement Controller of Mobile Robot and control method thereof

Country Status (1)

Country Link
CN (1) CN103753534B (en)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104133424B (en) * 2014-08-19 2017-01-18 福州大学 Industrial robot linear interpolation method based on programmable logic controller
CN104998848B (en) * 2014-09-10 2017-03-29 国家电网公司 Living water washing robot of rail mounted transformer station
CN104999464B (en) * 2014-09-10 2017-09-26 国家电网公司 Current conversion station living water washing robot and method
CN105032805B (en) * 2014-09-10 2017-04-05 山东鲁能智能技术有限公司 A kind of living water washing robot of transformer station that accurately can be rinsed
CN105014674B (en) * 2014-09-10 2017-11-14 国家电网公司 Current conversion station living water washing robot system and method
CN104647359A (en) * 2015-02-13 2015-05-27 南京阿凡达机器人科技有限公司 Robot with magnetic rotating positions
CN105234942B (en) * 2015-11-02 2018-08-10 国网山东省电力公司电力科学研究院 The control system and its control method of the big prudent small arm of hydraulic pressure
CN106476012B (en) * 2016-10-18 2019-04-02 国网山东省电力公司电力科学研究院 A kind of control method of auxiliary mechanical arm control system
CN108073162B (en) * 2016-11-11 2021-05-04 中国科学院沈阳计算技术研究所有限公司 Control method for realizing smooth motion of robot by inserting motion segment
CN106920380A (en) * 2017-03-14 2017-07-04 蒙柳 A kind of generic service robot security remote control
CN106976085B (en) * 2017-04-10 2023-03-31 深圳供电局有限公司 Control device of live working robot of transformer substation
CN108673508A (en) * 2018-06-08 2018-10-19 山东鲁能智能技术有限公司 The Multi-sensor Fusion control method and system of hotline maintenance robot
CN108758272B (en) * 2018-06-08 2020-07-03 国网智能科技股份有限公司 Insulation lifting arm system and method for live-line maintenance operation of transformer substation
CN111243253A (en) * 2020-01-10 2020-06-05 浙江金华文瑞机电有限公司 Receiving circuit of conveying equipment controller and remote control method
CN111844030B (en) * 2020-07-10 2022-04-05 珠海格力电器股份有限公司 Interpolation point generation method and device, processor and electronic device
CN112833854A (en) * 2020-12-31 2021-05-25 天津大学 Pose measurement system of planar mobile robot

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10000781A1 (en) * 2000-01-11 2001-11-29 Biedermann Motech Gmbh Device and method for remote maintenance of an electronically controllable prosthesis
US6385509B2 (en) * 1998-04-16 2002-05-07 California Institute Of Technology Tool actuation and force feedback on robot-assisted microsurgery system
CN101196551A (en) * 2007-05-10 2008-06-11 北京深浪电子技术有限公司 Ground wire patrol checking robot of high voltage power line
CN101738956A (en) * 2009-12-29 2010-06-16 哈尔滨工业大学 Flywheel simulator with fault simulating function and realizing method
CN102346473A (en) * 2011-09-05 2012-02-08 北京航空航天大学 Remote vehicle driving control device
CN202502070U (en) * 2012-03-20 2012-10-24 上海市电力公司 High-voltage transmission line eddy current testing robot system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6385509B2 (en) * 1998-04-16 2002-05-07 California Institute Of Technology Tool actuation and force feedback on robot-assisted microsurgery system
DE10000781A1 (en) * 2000-01-11 2001-11-29 Biedermann Motech Gmbh Device and method for remote maintenance of an electronically controllable prosthesis
CN101196551A (en) * 2007-05-10 2008-06-11 北京深浪电子技术有限公司 Ground wire patrol checking robot of high voltage power line
CN101738956A (en) * 2009-12-29 2010-06-16 哈尔滨工业大学 Flywheel simulator with fault simulating function and realizing method
CN102346473A (en) * 2011-09-05 2012-02-08 北京航空航天大学 Remote vehicle driving control device
CN202502070U (en) * 2012-03-20 2012-10-24 上海市电力公司 High-voltage transmission line eddy current testing robot system

Also Published As

Publication number Publication date
CN103753534A (en) 2014-04-30

Similar Documents

Publication Publication Date Title
CN103753534B (en) A kind of Movement Controller of Mobile Robot and control method thereof
CN104440864B (en) A kind of master-slave mode remote operating industrial robot system and its control method
CN109032138B (en) Consistency algorithm-based multi-robot formation control system and method
CN103984275B (en) A kind of universal industrial kinetic control system based on FPGA and control method based on this kinetic control system
CN102862161B (en) Field bus-based PAC (Programmable Automation Controller) industrial robot control system
CN101739865B (en) PLC-based two-dimensional motion demonstration platform for teaching and implementation method thereof
CN109571476A (en) The twin real time job control of industrial robot number, monitoring and precision compensation method
CN107505882A (en) A kind of multi-axis motion controller and control method
CN106502095A (en) A kind of cooperative control method of many industrial robots
CN101592951A (en) Common distributed control system for humanoid robot
CN101913149B (en) Embedded light mechanical arm controller and control method thereof
CN2927526Y (en) Teaching multiaxis distributed control system based on Ethernet and CAN bus
CN107804474A (en) Carry more rotor flying robot Complete machine system design methods of redundancy mechanical arm
CN105892412A (en) Multi-axis motion control hardware configuration based on custom bus
CN109968356A (en) Mechanical arm force-feedback control system and method based on Embedded Motion
CN204856122U (en) Punching press robot control system
CN106227097A (en) Multibus multi-axis motion controller
CN102354120B (en) Simulation experimental apparatus for intelligent arm support system of concrete pump truck and method thereof
CN204883256U (en) High real -time control system of robot framework
CN201728656U (en) Embedded light mechanical arm controller
CN204650244U (en) A kind of digital control system in open type based on EtherCAT bus
CN103817695B (en) A kind of control method of robot flexibility joint and drive unit
CN203825438U (en) Servo driver and multi-shaft control system using the same
CN204807988U (en) Motion control ware
CN214818593U (en) Robot control system

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CP01 Change in the name or title of a patent holder
CP01 Change in the name or title of a patent holder

Address after: 100031 Xicheng District West Chang'an Avenue, No. 86, Beijing

Co-patentee after: Electric Power Research Institute of State Grid Shandong Electric Power Company

Patentee after: State Grid Corporation of China

Co-patentee after: National Network Intelligent Technology Co., Ltd.

Address before: 100031 Xicheng District West Chang'an Avenue, No. 86, Beijing

Co-patentee before: Electric Power Research Institute of State Grid Shandong Electric Power Company

Patentee before: State Grid Corporation of China

Co-patentee before: Shandong Luneng Intelligent Technology Co., Ltd.

TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20201030

Address after: 250101 Electric Power Intelligent Robot Production Project 101 in Jinan City, Shandong Province, South of Feiyue Avenue and East of No. 26 Road (ICT Industrial Park)

Patentee after: National Network Intelligent Technology Co.,Ltd.

Address before: 100031 Xicheng District West Chang'an Avenue, No. 86, Beijing

Patentee before: STATE GRID CORPORATION OF CHINA

Patentee before: ELECTRIC POWER RESEARCH INSTITUTE OF STATE GRID SHANDONG ELECTRIC POWER Co.

Patentee before: National Network Intelligent Technology Co.,Ltd.