PID Controller Design for A Nonlinear Motion Control Based on Modelling the Dynamics of Adept 550 Robot

Similar documents
Physics 15 Second Hour Exam

Physics 120 Spring 2007 Exam #1 April 20, Name

EE 410/510: Electromechanical Systems Chapter 3

( ) ( ) ( ) ( ) ( ) ( ) j ( ) A. b) Theorem

Calculus 241, section 12.2 Limits/Continuity & 12.3 Derivatives/Integrals notes by Tim Pilachowski r r r =, with a domain of real ( )

PHY2053 Summer C 2013 Exam 1 Solutions

X-Ray Notes, Part III

Introduction to Inertial Dynamics

Chapter 6 Plane Motion of Rigid Bodies

Go over vector and vector algebra Displacement and position in 2-D Average and instantaneous velocity in 2-D Average and instantaneous acceleration

The Boltzmann transport equation and the diffusion equation

On Fractional Operational Calculus pertaining to the product of H- functions

Rotations.

Axis. Axis. Axis. Solid cylinder (or disk) about. Hoop about. Annular cylinder (or ring) about central axis. central axis.

ESS 265 Spring Quarter 2005 Kinetic Simulations

TWO INTERFACIAL COLLINEAR GRIFFITH CRACKS IN THERMO- ELASTIC COMPOSITE MEDIA

Physics 110. Spring Exam #1. April 23, 2008

THIS PAGE DECLASSIFIED IAW EO IRIS u blic Record. Key I fo mation. Ma n: AIR MATERIEL COMM ND. Adm ni trative Mar ings.

Complex Neuro-Fuzzy Self-Learning Approach to Function Approximation

Chapter 4: Motion in Two Dimensions Part-1

Analysis of Laser-Driven Particle Acceleration from Planar Transparent Boundaries *

OH BOY! Story. N a r r a t iv e a n d o bj e c t s th ea t e r Fo r a l l a g e s, fr o m th e a ge of 9

3D Motion Estimation and Texturing of Human Head Model

flbc in Russia. PIWiREE COHORTS ARE NOT PULL- ING TOGETHER. SIGHTS AND SCENES IN ST. PETERSBURG.

ON THE EXTENSION OF WEAK ARMENDARIZ RINGS RELATIVE TO A MONOID

P a g e 5 1 of R e p o r t P B 4 / 0 9

_ J.. C C A 551NED. - n R ' ' t i :. t ; . b c c : : I I .., I AS IEC. r '2 5? 9

Caputo Equations in the frame of fractional operators with Mittag-Leffler kernels

Chapter 3: Vectors and Two-Dimensional Motion

T h e C S E T I P r o j e c t

Chebyshev Polynomial Solution of Nonlinear Fredholm-Volterra Integro- Differential Equations

ANALYSIS OF KINEMATICS AND KINETOSTATICS OF FOUR-BAR LINKAGE MECHANISM BASED ON GIVEN PROGRAM

-HYBRID LAPLACE TRANSFORM AND APPLICATIONS TO MULTIDIMENSIONAL HYBRID SYSTEMS. PART II: DETERMINING THE ORIGINAL

THIS PAGE DECLASSIFIED IAW EO 12958

SYMMETRICAL COMPONENTS

CHAPTER 5 SPEED CONTROLLER BY SYMMETRIC OPTIMUM APPROXIMATION METHOD

c- : r - C ' ',. A a \ V

Large Scale Integration of Micro-Generation to Low Voltage Grids WORK PACKAGE A

African Journal of Science and Technology (AJST) Science and Engineering Series Vol. 4, No. 2, pp GENERALISED DELETION DESIGNS

Integral Solutions of Non-Homogeneous Biquadratic Equation With Four Unknowns

THIS PAGE DECLASSIFIED IAW E

Classification of Equations Characteristics

Physics 232 Exam II Mar. 28, 2005

Appendix. In the absence of default risk, the benefit of the tax shield due to debt financing by the firm is 1 C E C

A simple 2-D interpolation model for analysis of nonlinear data

1.B Appendix to Chapter 1

Lecture 9-3/8/10-14 Spatial Description and Transformation

2010 Sectional Physics Solution Set

THIS PAGE DECLASSIFIED IAW E

Electrostatic/magnetostatic forces

183 IV-4N. opo !PF. M1 -ri ChV. rrj: M D " ;jj. I o! 7-F J,. 1;", f y S}! f.'# t., owl, DeptE ResSIE. ,re:, 't.,". ± f. so.' f Y"3 7F. ..

Hyperbolic Heat Equation as Mathematical Model for Steel Quenching of L-shape and T-shape Samples, Direct and Inverse Problems

2 shear strain / L for small angle

P a g e 3 6 of R e p o r t P B 4 / 0 9

FRACTIONAL MELLIN INTEGRAL TRANSFORM IN (0, 1/a)

International Mathematical Forum, Vol. 9, 2014, no. 13, HIKARI Ltd,

Instructor: J.D. Williams, Assistant Professor Electrical and Computer Engineering

Vector Control of Faulty Three-Phase Induction Motor with an Adaptive Sliding Mode Control

Addition & Subtraction of Polynomials

, _ _. = - . _ 314 TH COMPOSITE I G..., 3 RD BOM6ARDMENT GROUP ( L 5 TH AIR FORCE THIS PAGE DECLASSIFIED IAW EO z g ; ' ' Y ' ` ' ; t= `= o

! -., THIS PAGE DECLASSIFIED IAW EQ t Fr ra _ ce, _., I B T 1CC33ti3HI QI L '14 D? 0. l d! .; ' D. o.. r l y. - - PR Pi B nt 8, HZ5 0 QL

Abstract. 1 Introduction

E-Companion: Mathematical Proofs

ME 141. Engineering Mechanics

Neutrosophic Hyperideals of Semihyperrings

Pricing Arithmetic Average Reset Options With Control Variates

Numerical Study of Large-area Anti-Resonant Reflecting Optical Waveguide (ARROW) Vertical-Cavity Semiconductor Optical Amplifiers (VCSOAs)

Nonlocal Boundary Value Problem for Nonlinear Impulsive q k Symmetric Integrodifference Equation

Example: Two Stochastic Process u~u[0,1]

Introduction. Voice Coil Motors. Introduction - Voice Coil Velocimeter Electromechanical Systems. F = Bli

Higher Order Binaries with Time Dependent Coefficients and Two Factors - Model for Defaultable Bond with Discrete Default Information

176 5 t h Fl oo r. 337 P o ly me r Ma te ri al s

( ) ( ) ( ) 0. Conservation of Energy & Poynting Theorem. From Maxwell s equations we have. M t. From above it can be shown (HW)

Physics 201 Lecture 15

Science Advertisement Intergovernmental Panel on Climate Change: The Physical Science Basis 2/3/2007 Physics 253

A L A BA M A L A W R E V IE W

Introduction to Robotics (Fag 3480)

_ =- 314 TH / 3 RD 60M AR M NT GROUP C L) _. 5 TH AIR F0 RCE ` Pl R?N ]9. ia UNIT, - _ : --.

AN ALGEBRAIC APPROACH TO M-BAND WAVELETS CONSTRUCTION

CITY OF TIMMINS BY-LAW NO

Physics 232 Exam I Feb. 13, 2006

Lecture 3 summary. C4 Lecture 3 - Jim Libby 1

Bayesian Credibility for Excess of Loss Reinsurance Rating. By Mark Cockroft 1 Lane Clark & Peacock LLP

s = rθ Chapter 10: Rotation 10.1: What is physics?

". :'=: "t',.4 :; :::-':7'- --,r. "c:"" --; : I :. \ 1 :;,'I ~,:-._._'.:.:1... ~~ \..,i ... ~.. ~--~ ( L ;...3L-. ' f.':... I. -.1;':'.

Technical Vibration - text 2 - forced vibration, rotational vibration

Convergence tests for the cluster DFT calculations

A Dynamical Quasi-Boolean System

Copyright Birkin Cars (Pty) Ltd

Empirical equations for electrical parameters of asymmetrical coupled microstrip lines

INTERHARMONICS ANALYSIS OF A 7.5KW AIR COMPRESSOR MOTOR

Field due to a collection of N discrete point charges: r is in the direction from

P-4( ?"1ST ttl 4 s r 6 e L. /tv NI/.cor GPAv-lb Lo U e. oufax,v 4 /9y, 993 -

Physics 232 Exam I Feb. 14, 2005

Consider a Binary antipodal system which produces data of δ (t)

H STO RY OF TH E SA NT

Review: Transformations. Transformations - Viewing. Transformations - Modeling. world CAMERA OBJECT WORLD CSE 681 CSE 681 CSE 681 CSE 681

Eastern Progress - 3 Mar 1923

Comparing and Expanding SDA and INA Techniques Applied to Physical Flows in the Economy

Controller design of a new active front steering system

Transcription:

nenonl ounl o nul Engneeng n Mngeen EM Vol. No. pp. 9-7 Alle onlne hp://www.n.un.c./je SSN 7-66 onolle egn o A Nonlne Moon onol Be on Moellng he nc o Aep 55 oo en Zhng epen o Mechncl Engneeng echnolog uue Une no ll oo 9 4 Noh n See We ee N 4797 US hhzhng@puue.eu ecee.5.; ee.6.; Accepe.6. Ac he ulple ln oo nonlne e n genel whoe chcec polnol no unque n whoe conol chee epen on pcul openg conon. Aong ll n o conolle ue o oo conol nel 9% conolle n he nul wol no onl ue o plc n eecene u lo o l o copng wh uncene n nonlnee n he e. Snce o o conolle e egne e on l n eo eho o lc-o pln o he pecon oon conol o oo oe ele o egn he conolle e on he hecl oel o he oo. h ppe ece o conolle egn o nonlne oon conol e on he hecl oellng o he nc o Aep 55 oo. he genel elonhp o he conolle egn on he ooc nc n he plnne jeco e ee. he nl n ulon o cloe loop nc nce eecene n n ccue jeco cng. he eul cn e pccll genelze o ohe ce o conolle egn o ohe oo n he nul pplcon. e wo: nonlne oon conol oo conolle. NOUON he ulple ln oo nonlne e n genel whoe chcec polnol no unque n whoe conol chee epen on pcul openg conon. Aong ll n o conolle ue o oo conol nel 9% conolle n he nul wol no onl ue o plc n eecene u lo o unel n el. conolle cn e egne ccong o n unng eho een he hecl oel o he e no lle o uncene n nonlnee wee oun n he e. conolle h l el uneoo phcl enng: he popoonl conol poe eong oce h popoonl o he nnneou eo eween he e pon n he poce le he oen u en up wh e-e eo ue o con g o o; he negl conol conue coece oce h popoonl o he u o ll p eo ulple he own e nel o h he e-e eo cn e elne u cue oehoo o he e epone; ee conol nouce o e he oehoo ue poucng counece oce h popoonl o he e o chnge o eo. Wh hee unenng oen engnee who o no he ecll nng o conol heo cn egn conolle o he nul poce whoe ne uncon e unnown o he. h wh o o conolle e egne e on l n eo eho o lc-o pln. owee o he pecon oon conol o oo he l n eo ppoch no n ecen w. n ecen e oe n oe eeche o egn een pe o conolle e on heoecl nl o el wh nonlne o non-eplce o een pplcon uch noo lp oo go o lne-o-gh e wo wheele uonoou lncng oo pllel npulo ec. [ 4 5 6 7 8]. eone h he heoecll egne conolle cn e opll une o he nee o pecc e o genec o ee peonce hn h he l-n-eo lenng egne conolle h. h ppe ece o eploe heoecll egne conolle o nonlne oon conol on he o he hecl oel o Aep 55 oo. A one o he o coonl ue oo n he nul poucon lne he Aep 55 oo ou SAA oo wh hee oonl jon n one nlonl jon Fg. -. houle eoe wh he oonl jon elow wh he oonl jon n w wh he oonl jon 4. ecl oon ccoplhe wh he nlonl jon. Snce eue ll oon enelope whle pee n plo e elel hgh Aep 55 oo cn e oun n echncl el el EM

Zhng hnlng pcgng chne enng cewng n n ohe opeon equng n pece uoon.. E YNAMS OF AE 55 OBO. he n oon n nee nec elonhp Accong o he en eneg - coone he z - n he econ o he jon Aep 55 h he pecl ce o pllel z e connece wh he g nne n oue ln. he jeco o he oo eene he oon o hee wo ln n he w he oonl jon oe ou he z o ju he gppe ngle u no o chnge he jeco. n oe o ocu on he jeco u whou lo genel we ue he w o ngle zeo. heeoe he coone e o ece jeco n ln poon cn e pl peene ollow Fg. : Fgue. Aep 55 oo wh jon locon [] Neele o coplee u o conolle egn e on he hecl oel o Aep 55 enngul o nul pplcon. he geoec enon o Aep 55 e hown n Fg. o oellng n ulon. Fgue. op ew o Aep 55 wh jon oe ngle le. l he - pee o he nne n oue ln. le. - ee n α nne Oue Fo he nne ln n oue ln he coone noon wh oon n nlon coponen ece wh he : A z z α Fgue. Aep 55 enon [] n n α α nα n nα nα α n EM

Zhng EM he ple noon o Aep 55 o he e o he gppe ollow: A A n n n n Nocng he elonhp he ngul poon o he oo n he ngle ou peou z o ol o new : he gppe hozonl poon cn e epee : n n Fo Equon he oo ngul poon cn e ee: ± ± n n 4 whee 5. Fow n Bcw Veloc n Acceleon elonhp he ow eloc cn e oun o Equon : 6 whee con n n 7 An he cw eloc cn e ee ollow: o n n n 8 Alo he elonhp o he ow cceleon cn e eene: 9 whee n n he elonhp o he cw cceleon e ollow: n * n n. Moellng n Sulon o he nc o Aep 55 oo Fo he ple ucue o he oo hown n Fg. 4 he nne ln n oue ln e epeene g wh he cenl he cene n he gppe n lo e olze. Ou o eel coonl ue eho o oelng he oo nc gnge eho eploe o eelop he nc oel o Aep 55 oo. he gnge uncon he eence o he

Zhng EM ol nec eneg n he ol poenl eneg V.e. V Fgue 4. Sple ucue o Aep 55 oo Fo he ooc ucue hown n Fg. 4 he ol nec eneg epee : pc oon whee c c c pc 4 4 4 oon 5 An he ol poenl eneg V gen : V g V png V 6 whee n g g g V g n g g 7 png V 8 hu he nc o Aep 55 oo ece gnge eho ollow: V V 9 Suung Equon 8 no Equon 9 eul n: 7 n g 7 n g enong n coneng png oque png o he nne n oue ln Equon cn e ewen : png whee 7 7 n n g g

Zhng png whee coecen. ngul plceen eg 5 5 5 5-5 - png png copoe o he png e e -5.5.5.5.5 4 4.5 5 e ec Fgue 5. nc epone: ngul plceen ngul eloc eg/ec 5 4 - - eloc o e eloc o e -.5.5.5.5 4 4.5 5 e ec Fgue 6. nc epone: ngul eloce cn e oee h he nc oel o Aep 55 oo hghl nonlne e. he ulon o he oo nc wll e peoe wh A-Bhoh ecue chee whch h een pple o genel open-chn pe npulo n poen o e uch oe ecen n copuonl lo hn he nonecue eho. h epecll he ce when he e hghl nonlne. Fg. 5 n 6 pl he nc epone o ngul plceen n eloce wh he nl conon gen gppe poon. he ulon llue he nc oelng o Aep 55 eelope gnge eho n eone he l o he oo oon. h een oee h he hee he lo he longe e he e o e ele; n when he lo hee hn cen wegh he gppe e ecoe unle..4 Sene o Sc oque n Open oop onol n he open loop conol o Aep 55 oo he ene o ngul plceen o c oque nce how well he gppe cn hol poon. hee ene o ngul plceen o c oque e ollow: g g n n Von o c oque n he open loop wll pouce eo n ngul plceen. A cloe loop poon conol ele o e h ue Fg.7. Fgue 7. oo conol g. OBO ONO AN S SMUAONS. oo nc wh onolle j h g ue h he oo ng he nne n oue ln e he e pe o oo. oneng he B V oo pee nc o he wo ln ece : n j j n j j j 4 EM

4 Zhng Snce whee he ge o he wo nc equon o oo ln n ng oo epee n Equon 4 cn e cone no ngle one: e B e V 5 he conol lw o he conolle n oo e he nne o oue ln ollow: V 6 he loc g e on he ne uncon o Equon 5 n 6 o he oo conol hown n Fg. 8. Fgue 8. conolle ooc oon he ne uncon o he cloe loop e : e B e B e e 7 oo ocu whee he nonlne e e ee unce o he e: g g n n 8 lcng he hee pole p ς ωn ± jωn ς o he chcec polnol ono he le hl-plne n egnng ς ω ± jω ς he onn pole n n n p o npule he oo locu el he ollowng elonhp on he conol pee: ω ς ω p ω n n p e n e ς ωn p e Be 9 oo locu nl o he nne ln n oue ln o he une conolle eone n Fg. 9. oo ocu 8 5 6 4 5 gn A gn A - -5-4 - -6-8 -5 - -7-6 -5-4 - - - el A - - - -8-6 -4 - el A Fgue 9. oo locu nl o nne ln n oue ln EM

Zhng 5 EM Nocng he nc o he nne o oue ln cn e ece e e B Equon cn e ewen n o: whee e e B B e e n n n n g g. jeco lnnng he conolle cn e egne o peo jeco cng o he nl poon o o o he nl poon e. Whou lo o genel he oon n ue wh ollowng conn: o > n conn cceleon n e nel [ ] conn pee n e nel [ ] n conn cceleon n e nel [ ] whee o gen conn pee o he jeco coponen cn e epee ollow: < < o o 4 Fg. pl he ule jeco ece n Equon n 4 o gen e o pee. An he jeco coponen cn lo e epee n he l w. hen he ee ngul plceen eloc n cceleon cn e eene: ± ± n n 5. Sulon o he loe oop onolle oo nc enong [ ] X Equon cn e ewen X X 6 e Equon 5 he jeco ele ce n eco gen Equon cn e eene. hen he cloe loop conolle nc o Aep 55 oo epee n Equon o ung he plnne jeco cn nuecll ule.

6 Zhng ee plceen n ee eloc n /.6.5.4.......4.5.6.7.8.9 e ec -. -.4 -.6 -.8....4.5.6.7.8.9 e ec ee cceleon n / - -....4.5.6.7.8.9 e ec Fgue. ee jeco plnnng n n oe o e he eecene o he conolle e on nc o Aep 55 oo he ollowng ce gen o ulon: ue he conolle wh ccl p o oh nne ln n oue ln he gppe oe o he nl poon 58 54 o he nl poon 7 54 whn ec. Fg. how he ulon eul o Equon 6 ecuel nege A Bhoh eho. plceen n plceen n.8.7.6.5.4... --- ee -.-.- cul....4.5.6.7.8.9 e ec.8.7.6.5.4... --- ee -.-.- cul....4.5.6.7.8.9 e ec Fgue. Sulon o conolle jeco cng cn e oee h he jeco cng poce n le. eluon gen n he ppen. 5. ONUSON he conolle egn o nonlne oon conol e on he hecl oellng o he nc o Aep 55 oo eploe. he genel elonhp o he conolle egn on he ooc nc n he plnne jeco e ee. he nl n ulon o cloe loop nc nce eecene n n ccue jeco cng. he poceue n nl o h eech cn e pccll genelze o ohe ce o conolle egn o ohe oo n he nul pplcon. enngul o opzng he coonl ue conolle whou l-n-eo eng n epecll pon o pecon opeon. Acnowlegeen he uho nceel hn Fo Moo o. o ponong h eech p o Fo Sewhp unng. he helpul cuon wh oeo ell Bu he Une o Aon lo gel ppece. 6. EFEENES [] n.. ee.. n hoh.. -Augene Ape onol o A o Mo o Se An ounl o onol Vol. 4 No. une pp. 4-45 [] Oung.. Zhng W.. n F. X. Wu Nonlne onol o jeco cng wh oneon o he egn o onol Mehoolog oceeng o he EEE nenonl oneence on ooc 8 Auoon Whngon M pp. 46-4 [] wu. o. Yoo M.. n Ohuch A. 5 Moon egn o noo Blp oo wh onolle ounl o ooc n Mechonc Vol. 7 No. 5 pp. 5-58 [4] Su Y.X. Sun. n un B.Y. 5 egn o n enhnce nonlne conolle Mechonc Vol. 5 pp. 5 4 [5] hee O.Y. Shu M. n An Z. 6 egn n eelopen o wo Wheele Auonoou Blncng oo EEE Suen oneence on eech n eelopen Shh Al Selngo Ml une 7-8 pp. 69-7 [6] o.m. Vg E. ooe E. oeo.. n ez.. 6 neuc lne onol o Mnpulo oo he 6 oneence on nc nuenon n onol. Augu -6 Queéo Qo. [7]. wu. Mngw Y. Yoo M. n Ohuch A. 6 lnng o oon conolle o n noo lp oo Acl e n ooc Volue Nue Noee pp. 77-84 [8] Su W. 7 A Moel eeence-be Ape onolle o oo Moon onol o No Eplcl nown Se nenonl ounl o nellgen onol n Se Vol. No. Sepee pp. 7-44 [9] Aep 55 oo nucon noo www.ep.co/n/e//oo/aep55/55b.f [] ollech.m. 98 A ecue gngn oulon o npulo nc n cope u o nc oulon cople ncon o he ASME ounl o nc Se Meueen n onol Vol. No. pp. 69-76 EM

Zhng 7 Appen: Vlue o e pee n eluon he lue o he e pee o he oo nne n oue ln e le ellow o nuecl ulon: he ne uncon o he nne ln: nnen 9.86 4. he ne uncon o he oue ln: Ouen 4 476 4.6.4 he conolle o he nne ln: 9. N 4 476 7.997 N/. N he conolle o he oue ln:.97 N.97 N/.76 N he poon eo ene e jeco cul houl he ollowng equeen he nl poon: e. 5 he cul eo he nl poon e. 94. he uncon N e e N houl he ollowng equeen oe he ene jeco:.5 he cul uncon.8. EM