71
! : 1/11/2010

eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

  • Upload
    others

  • View
    0

  • Download
    0

Embed Size (px)

Citation preview

Page 1: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

:

1/11/2010

Page 2: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

2

........................................................................................................................................ 4

: ......................................................................................................................... 4

: ................................................................................................... 4

.......................................................................................................................... 4

1. ...................................................................................................... 6

.................................................................................................................................... 6

1.1 μ ........................................................................................................................ 6

1.2 μ ................................................................................................................................ 7

..................................................................................................................................... 10

2. - ...................................... 11

.................................................................................................................................. 11

..................................................................................................................................... 15

3.SCORBOT-ER III ........................................................................................................................ 16

.................................................................................................................................. 17

3.1 ................................................................................................................................. 17

3.2 SCORBOT - ......................................................................................... 19

3.3 ROBOT ................................................................................ 19

3.4 SCORBOT-ER III .................................................................................. 20

3.5 ................................................................................................................................ 22

3.6 ....................................................................................................................... 28

3.7 SCORBOT-ER III ............................................. 29

3.8 ROBOT ‘’HOME’’ ................................................................................................................ 31

3.9 SCORBOT-ER III .............................................................. 32

3.10 SCORBOT ............................................... 33

3.11 ................................. 34

3.12 DRIVER ............................................................. 34

..................................................................................................................................... 36

4.SOFTWARE /C ........................................................................................................................ 37

AT90CAN128 OLIMEX .................................................................... 37

.................................................................................................................................. 38

4.1 μ PC ........................................................................................ 38

μμ SCORBOT. ................................................................................................. 43

Page 3: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

3

4.2 goPosition (POSITION). ............................................................... 44

μμ Home SCORBOT. ................................................................................... 45

4.3 goHome ( HOME). ................................................................. 46

4.4 μ PWM ................................................................................. 47

..................................................................................................................................... 47

5. SOFTWARE PC .......................................................................................................................... 48

.................................................................................................................................. 48

5.1 μ ( – μ μ ) .................................... 48

5.2 ( μ ) Matlab ............................................................................................. 48

μμ . ......................................... 49

5.3 μμ μμ ........................................................................ 51

5.4 μμ .................................................................. 55

..................................................................................................................................... 56

.......................................................................................... 57

( ) .......................................................................................................................... 59

MATLAB ........................................................................................... 59

( ) .......................................................................................................................... 60

AT90CAN128 .................................................................................... 60

( ) .......................................................................................................................... 61

SCORBOT ER-III ......................................................................... 61

................................................................................................................................... 70

Page 4: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

4

:

μ μμ matlab μ μ ,

μ . μ μ .

:

SCORBOT-ER III

• μμ MATLB

• μμ CodeVisionAVR

• μμ AVR STUDIO

Web camera

AT90CAN128 OLIMEX

1 μ μ .

2 μ μ μ . μ μ , μ μ μ

μ μ , μ μ μ μ μ

μ

3 SCORBOT ER III. μ , μ μ μ μ : μ . μ μ

DC , μ encoders

Page 5: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

5

4 μ μ μ at90can128. μμ SCORBOT ER III, goPosition

μ μ , μμ goHome μ , μ PWM

5 μμ μ matlab. μ μ μ . μ matlab, μμ

, μμ μμ μμ .

Page 6: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

6

1.

μ μ .

μ μ μ . μ μ : AGVs (Automatic Guided Vehicles), μ , μ , ROVs (Remotely Operated Vehicles), μ , AUVs (Autonomous Underwater Vehicles)

μ : , μ μ μ μ , , μ μ

, μ .

1.1 μ μ :

μ : μ μ ( μ ) μ μ μ μ .

μ μ μ ( ). μ μ μ μ

μ , μ .

μ μ : μ μ μ μ μ . μ , μ

( ) ( μ ). μ μ μ μ μ μ . μ :

• AGVs: (Automatic Guided Vehicles), μ μ , μ μ μ

μ .

• μ μ : μ μ μ μ . μ μ

μ μ μ μ .

• μ : μ μ μ μ μ .

μ μ μ

Page 7: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

7

μ μ μ . μ μ

μ μ .

• ROVs: (Remotely Operated Vehicles) μ μ μ . μ

μ μ μ , μ μ μ μ μ μ

. μ μ μ .

• AUVs: (Autonomous Underwater Vehicles) μ ROVs μ .

μ μ , μ μ μ . AUVs μ

μ μ μ .

• μ : μ μ μ μ , . μ μ

μ , μ μ μ μ μ μ .

1.2 μ

μ μ μ μ .

μ μ μ μ :

• ( . . μ μ , , μ )

• μ μ μ μ ( . . , μ )

• μ

• μ μ ( . . CNC, injection moulding, laser cutting, )

• μ μ

μ μ μ μ μ .

Page 8: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

8

μ

μ μ μ , μ , μ μ 2, 4 6

SCARA, μ ( 50 ) . μ μ μ

μ μ μ μ , . μ μ

μ μ (Vision) μ μ . μ μ

(blisters) . μ μ

μ ( . . ).

& –

μ μ μ μ ,

μ . μ μ μ . μ , μ μ

4 6 μ μ μ , μ μ .

μ μ , μ μ

μ μ , μ μ , .

μ μ μ μ , μ .

μ μ μ , , , , . μ μ

μ , μ , μ , . . μ μ 4 6 μ μ μ 100

450 . « » μ . μ μ μ

μμ . (layer palletiser).

μ μ :

• μ ( 4 ) μ

• μ

• μ μ

Page 9: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

9

• μ μ μ

• μ μ

• (stretch wrapping)

• μ μ μ RFID

• μ μ (μ PLC )

• μ ( , )

, μ μ μ , μ μ μ , μ

μ μ . μ μ μ μ μ , μ μ ( μ , ), μ μ μ . μ

, μ ( . . ).

μ ( μ ) ( MIG TIG) μ

μ . μ μ ( . . μ , μ μ μ μ μ , , ).

μ μ μ . μ μ μ μ μ μ μμ

μ μ μ μ μ ( , . .).

μ , . μ μ

μ μ , μ ( ) μ . μ μ

μ μ μ μ . μ μ μ μ , μ

, μ μ μ . μ μ . , ,

μ μ μ ( μ ) .

μ ( μ ) ( PLASMA, LASER, WATER JET) μ μ μ μ . μ μ

( . . μ μ ). μ μ μ μ . μ

Page 10: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

10

μ μ μ μ μ μμ μ μ μ μ . μ

μ , μ . μ μ μ μ , μ , μ μ ( ).

μ ( μ ) ( ) μ μ . μ μ ( . . -μ , μ . .) μ μ μμ , μ

μ μ . μ μ μ μ μ , μ μ , μ μ . . μ ,

μ μ . μ μ μ . μ μ

μ , μ μ μ μ . μ μ , , μ , μ .

& μ

μ μ ( . . CNC, injection moulding, laser cutting, CNC ) μ μ μ μ .

μ μ μ 3, 4 6 μ μ . μ , μ μμ μ ,

μ μ . μ μ μ μ μ . μ , μ

μ μ μ μ , μ

μ μ .

μ μ .

Page 11: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

11

2. -

μ μ μ . μ μ , μ μ μ

μ μ , μ μ μ μ μ . μ μ μ μ μ

μ μ .

μ μ μ μ μ . μ μ μ μ μ μ .

μ μ

μ μ μ μ μ μ . μ μ

. μ μ μ μ μ .

μ μ . μ μ μ μ

.

μ μ μ μ μ

2.1

Page 12: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

12

μ μ TCP μ μ μ μ μ . μ μ Ax=

8, Ay = 6, L=7 μ . μ μ μ

.

μ μ 1 2. 1 2, μ TCP μ , μ μ 2.

10)68()( 21

2221

22=+=+= AyAxP

μ μ :

2

2

22 )180cos( pLLLL =+

2

22

2

2)180cos(

L

LP=

o

L

PL

L

LP

9249

100492arccos

2arccos

2cos

2

22

2

2

22

2

===

=

1 μ :

+=1

:

o

Ax

Ay

378

6arctan

arctan

=

=

μ :

sinsin

c

b

b=

2 2

Page 13: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

13

μ μ μ :

814437

4410

92sin7arcsin

sinarcsin

sinsin

1

2

2

=+=+=

==

=

o

o

P

L

P

L

μ 2 . μ μμ ,

1 2. μ , 2 .

μ , μ TCP μ μ A =8, Ay =6, μ :

1 = 81

2 = -92

μ μ μ μ μ

2 3

TCP μ μ μ μ μ = 4, y = 3, Az = 5. μ

TCP μ ;

Page 14: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

14

1.18 μ μ μ μ 1, 2 R.

μ μ μ μ μ : μ 1, 2 R μ

μ .

μ μ μ μ μ μ μ . :

2sinRA

Z= (1)

XY μ μ OP μμ μ :

2cosROP =

OP :

(2)

OP Y :

1sin=OPA (3)

(1), (2), (3) μ

2

12

12

sin

sincos

coscos

RA

RA

RA

Z

X

=

=

=

AY μ AX, μ :

1tan=

X

Y

A

A

1, :

XA

A= arctan

1

μ , A , AZ, μ R:

21222)(

ZYXAAAR ++=

μ R, 2 μ μ AZ:

R

AZ

arcsin2=

1cos=OPA

X

Page 15: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

15

M μ μ μ μ , :

o

o

R

4507.7

5arcsin

07.7)534(

374

3arctan

2

21

222

1

==

=++=

==

μ μ μ μ TCP μ .

μ μ μ .

Page 16: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

16

3.SCORBOT-ER III

Page 17: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

17

SCORBOT ER III.

:

1. μ , μ μ μ μ : μ . μ μ DC

, μ encoders, 42 7 .

2. SCORBOT ER III μ μ , μ , , .

3. SCORBOT ER III

4. HOME SCORBOT ER III μ μ ,

SCORBOT ER III , μ μ , drivers.

3.1

SCORBOR-ET III JAR (Joint Arm Revolute) μ μ μ μ . μ μ

μ μ , μμ μμ μ μ . μ , μ

μ μ μ μ μ . μ μ

μ .

μ SCORBOT-ER III :

μ , 6 .

μ μ μ 5 6 dc motor μ .

μ .

μ robot μ ( ) μ μμ .

μ . μ μ μ μ . μ μ μ μ leaser.

μ μ μ μ μ spray gun μ μ .

Page 18: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

18

SCORBOT-ER III μ . :

: μ μ – .

μ : μ μ y- .

: μ μ μ - .

: μ μ μ μ μ . – .

- μ . μ μ μ .

SCORBOT-ER III:

• 1: 310 μ

• 2: μ μ +130 / -35 μ

• ¢îïíáò 3: Óôñïö Áãê íáò + - 130 ìïéñ í

• 4: + - 130 μ

• 5:

• 6: μ / μ + μ

• : 61 (24.4 ")

• : 75 (3"), μ 65 (2.56 ") μ μ

• : 1kg (2.2 LB)

• : 6 DC Servo Motors μ Closed-Loop Servo Control

• 6 (optical encoders)

• 5 μ ( home robot )

• μ : + - .05 mm (+ - 0.02 ")

• : 330mm/Sec. (13"/Sec) (13 "/ sec)

• : 11kg(24Lb)

Page 19: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

19

3.2 SCORBOT -

μ μ μ :

• μ μ .

• μ μ .

• μ μ μ μ .

• μ μ μ μ DC servo motor.

3 2 1

3.3 ROBOT

4 1

Page 20: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

20

3 3 1

μ μ (DC motors). μ :

μ μ , .

μ μ . o μ μ .

μ SCORBOT-ER III, (μ ). ,

, ( ), μ μ μ . μ

μ μ μ μ , μ μ .

μ μ , μ μ μ μ

μ μ .

3.4 SCORBOT-ER III

, DC , μ encoders, 42 . 7 :

2 motor

2 μ μ ( μ ) encoder

1 led encoder (Vled)

1 μ μ μ home robot

Page 21: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

21

1 encoder μ

robot μ μ . μ μ μ robotμ D50 ( 50 pins).

Page 22: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

22

3 4 1

3.5

μ SCORBOT-ER III μ μ . μ μ μ , μ

μ , μ .

SCORBOT-ER III 3 μ , μ . μ μ (Tm: μ μ

μ μ ):

• , μ , (motors): m 1,2,3 = 127.7:1

• (motor): Tm 4,5 = 65.5:1

• (motor): Tm 8 = 19.5:1

, μ μ 127.7:1, μ 127.7 μ μ .

Page 23: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

23

3 5 1

μ μ μ 1.4. μ μ μ μ μ .

μ μ μ μ μ .

3 5 2

μ :

ma = 24 teeth.

Mb = 120 teeth.

Wa = W 1,2,3 = 18.88 rpm

Sa = S 1,2,3 = 0.47o

μ

μ μ SCORBOT-ER III μ μ μ . μ μ μ μ – μ μ

μ . μ .

μ μ . μ μ μ μ .

μ :

Page 24: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

24

na = 18 teeth.

Nb = 72 teeth

Wa = W 1,2,3 = 18.88 rpm

Sa = S 1,2,3 = 0.47o

3 2 3

μ , μ μ μ μ . μ . , μ

μ 1.5.

O μ μ ( μ ) μ .

μ μ μ , . C μ μ B μ μ . C D μ μ .

μ :

na = 18 teeth.

nb = 72 teeth

nc = 17 teeth

nd = 17 teeth

Wa = W 1,2,3 = 18.88 rpm

Sa = S 1,2,3 = 0.47o

Page 25: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

25

3 5 4

μ SCOREBOT-ER III, μ up/down (pitch) μ (roll).

SCORBOT-ER III , 1.6.

1.9, 3 μ . μ 1 2 μ 4 5, . μ μ 1 2

μ 3, μ μ , μ ( 1.10):

i. 1 2 μ , μ 3 . pitch.

ii. 1 2 μ , μ 3 . roll.

32 (teeth).

3 5 5

Page 26: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

26

μ pitch roll, μ μ 4 5 . (μ μ .)

μ μ 4 5 , μ 1.6.

μ μ 4 ( μ 5) :

A μ μ μ .

B A μ μ 1.

C μ B ( ).

D C μ μ 2.

E μ D ( ).

F E μ μ 3.

μ μ F μ μ .

μ :

na = 12 teeth.

nb = nc = 24 teeth

nd = ne = 24 teeth

nf = 24 teeth

Wa = W 4,5 = 36.85 rpm

Sa = S 4,5 = 0.916o

SCOREBOT-ER III μ μ μ μ . μ μ μ μ μ . μ

μ , . μ μ μ μ , 1.8.

Page 27: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

27

3 5 6

, . μ μ μ μ ,

1.9. , μ μ μ , μ

μ .

3 5 7

μ μ μ SCORBOT-ER III μ . μ

μ .

Page 28: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

28

3.6

, μ , μ , ( ).

μ , μ μ . , μ μ

, μ μ μ .

SCORBOT-ER III μ :

(encoder).

(encoder wheel).

μ encoder μ μ μ μ 5V.

4 5 motors 6 motor 3 .

3 3

Page 29: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

29

μ μ μ μ . , μ ,

μ . , μ μ μ - μ μ

μ μ , μ μ μ μ μ , μ μ

μ μ μ .

3.7 SCORBOT-ER III

μ SCORBOT-ER III μ .

μ SCORBOT-ER III

3 4

μ μ μ μ μ . μ .

LED, μ . , μ .

μ , μ LED- . , μ μμ μ μ .

LED- .

Page 30: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

30

Led’s ( μ ) μ μ , μ μ 5 , '

μ . μ μ μ .

μμ μ μ led , , ,

μ . , μ μ

1.13, μ (0V) (4V), μ μ .

3 7 2

μ SCORBOT-ER III 6 . μ , μ ( ), 6

. μ , μ μ ( ) :

S = 360o/6 = 60

o

μ , μ μ . . . μ μ μ μ

- μ . μ μ 127.7:1. μ , μ

μ :

S = 60o/127.7 = 0.47

o

μ ( F) :

Page 31: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

31

Sjoint = S * (na/nb) * (nc/nd) = 0.47o * (18/72) * (17/17) = 0.12

o

μ 0.1 μ , μ μ .

3 7 3

3.8 ROBOT ‘’HOME’’

robot ‘home’ , μ μ μ . μ , μ

‘home’. μ μ μ μ μμ . μ μ ‘home’

μμ μ .

μ ‘home’ μ μ . μ

. μ , , ‘home’

μ .

Page 32: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

32

3 8 1

3.9 SCORBOT-ER III

μ μ μ μ μ μ μ , μ

μ μ . μ μ μ μ μ μ μ μ

.

μ μ μ

μ - μ , , μ μ ( μμ ) μμ . SCORBOT-ER

III.

ER iii 110/220 VAC 60/50 Hz

μ 5

1Kg 0.5mm

Page 33: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

33

3.10 SCORBOT

μ μ μ μ 150 VA μ μ 9 V μ 24 V. 9V μ μ 5V

μ . μ μ 15 V SCORBOT-ER III.

μ μ :

0-15 V

• encoders

0-5 V

330 mms per sec

6 DC servo motor μ

μ 340

μ +/- 85

+/- 150

+/- 150

roll

610mm

μ 75mm μ

65mm μ μ , μ ,

Page 34: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

34

• μ

5V

3.11

μ μ AT90CAN128 OLIMEX. AT90CAN128 :

• 5 V

• 7 PORTS

• μ μ 16 MHz

• 4 timers – 1 watchdog

• 2 usart

μ SCORBOT-ER III.

PORTA( ): SCORBOT

PORTB( ): μ SCORBOT home.

PORTC( ): motors μ PWM.

interrupt μ μ μ . interrupt falling edge.

TIMER0 μ 250 KHz (16MHz/64, μ 64) overflow interrupt.

TIMER0 μ μ PWM μ PWM μ .

interrupt μ μ matlab.

3.12 DRIVER

driver μ μ L298 . μ Vs 15V DC. pins input μ

Page 35: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

35

, μ 0V 5V input ( pins input , 0V, 5V, ).

pin enable μ PWM, μ , μ 0 V μ o Vs, μ 15 V .

Page 36: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

36

SCORBOT ER III. μ , μ μ μ μ : μ , μ , , , μ home,

, SCORBOT ER III , μ μ , drivers.

Page 37: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

37

4.SOFTWARE /C

AT90CAN128 OLIMEX

Page 38: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

38

μ μ μ at90can128. μμ SCORBOT ER III, goPosition μ μ , μμ goHome

μ , μ PWM

.

4.1 μ PC

μμ μ μ at90can128 CodeVisionAVR. -μ

μ J-tag μ μμ CodeVisionAVR J-tag μ μμ AVRstudio μ μ .

μ CodeWizardAVR μμ μ μ SCORBOT :

• Chip: μ μ AT90CAN128 μ 16 MHz .

4 1 1

Page 39: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

39

• ‘ ’ :

PORTA( ): SCORBOT

pin_7:base moves: 1:left, 0:right

pin_6:shoulder moves: 1:up, 0:down

pin_5:elbow moves: 1:down, 0:up

pin_4:left wrist moves: 1:out, 0:in

pin_3:right wrist moves: 1:in, 0:out

pin_2:gripper moves: 1:open, 0:close

pin_0:home SCORBOT

PORTB( ): μ SCORBOT home.

pin: 2-6

PORTC( ): motors μ PWM.

pin_0:base

pin_1:shoulder

pin_2:elbow

pin_3:left wrist

pin_4:right wrist

pin_5:grippe r

Page 40: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

40

4 1 2

• interrupt μ μ . μ ( , μ , , , ). interrupt

falling edge.

INT0: elbow

INT1: shoulder

INT2: base

INT4: gripper

INT5: left wrist

INT6: right wrist

Page 41: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

41

4 1 3

• TIMER0 μ 250 KHz (16MHz/64, μ 64) overflow interrupt. TIMER0

μ μ PWM μ PWM μ .

4 1 4

Page 42: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

42

• interrupt μ μ matlab. interrupt

μ Matlab.

4 1 5

Page 43: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

43

μμ SCORBOT.

Page 44: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

44

4.2 goPosition (POSITION).

• μ 1: interrupt usart0_rx_isr μ μ matlab μ

• μ 2: μ interrupt usart0_rx_isr μ rx_buffer0[] μ . rx_buffer0[0]-rx_buffer0[2]

μ μ μ μ .

:

0: μ , 1: μ , 2: bit_0: Home bit_2-7 , 3: ,4: MSBs , 5: LSBs , 6: MSBs μ , 7: LSBs μ , 8: MSBs , 9: LSBs , 10: MSBs ,11: LSBs

, 12: MSBs , 13: LSBs , 14: MSBs , 15: LSBs

• μ 3: μ main goDir ( ) rx_buffer0[2], μ μ

rx_buffer0[4:15] μ . μ

μ (position).

• μ 4: μ (PWM) PORTA . μ μ encoders interrupts, μ μ μ μ . μ μ

μ μ , interrupts μ . μ μ , ,

. μ μ μ lastDir μ

Home.

• μ 5: .

Page 45: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

45

μμ Home SCORBOT.

Page 46: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

46

4.3 goHome ( HOME).

• μ 1 μ 2 μ μ

• μ 3: μ main μ (setHome = (rx_buffer0[2] & 0b00000001) == 0b00000001;) bit home, 1

home (goHome).

• μ 4: μ home μ (PWM) (PORTA) μ μ lastDir

μμ (position). μ μ μ μ , interrupts μ . μ

μ μ μμ . μ μ , .

• μ 5: home.

Page 47: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

47

4.4 μ PWM

μ ( , μ , , )

μμ μ μ μ PWM. μ μ μ μ μ .

μ μμ μ TIMER0 μ 64 (TCCR0A=0x03). μ μ PWM (0: μ 100%, 255: 0%) .

μ interrupt TIMER0 μ TCNT0 μ PWM.

if (pwm<TCNT0)

PORTC.2 = 1;

else PORTC.2 = 0;

μ μ μ at90can128. μμ .

Page 48: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

48

5. SOFTWARE PC

μμ μ matlab. μ μ . μμ

, μμ μμ μμ .

5.1 μ ( – μ

μ )

μμ μ ( μ x,y.

μ , μ , μ μ scorbot.

μ μ μ matlab scorbot home μ μ

.

5.2 ( μ ) Matlab

MATLAB μ μ μ μ μ μ μ μ μ μ μ μ (scientific computing). μ

MATtrix LABoratory ( ). MATLAB (interactive) μμ μ μ μ (data visualization) μ μμ μ μ

.

μμ μ MATLAB μ μμ . MATLAB μ μ

μ μ μ , μ μ . μ

μ μ Maple Mathematica.

μ ( μ ) μ MATLAB μ μ .

μ μ μ μ μ . μ MATLAB help( ).

μ MATLAB: http://www.mathworks.com μ μ .

Page 49: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

49

μμ .

Page 50: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

50

Page 51: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

51

5.3 μμ μμ matlab μ μ

μ :

μ 1: . μ μ μ scorbot.

5 3 1

5 3 2

μ 2: μ μ μ μ . μ (x,y)

.

Page 52: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

52

5 3 3

5 3 4

5 3 5

Page 53: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

53

5 3 6

μ 3: μ (x,y) μ .

μ 4: (x,y,z) (z: μ ) ( ( 1), μ ( 2), ( 3)). μ μ

μ μ .

μ 5: matlab matlab μ μ .

μ 7: μ μ

5 3 7

Page 54: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

54

μ 8: matlab matlab μ μ .

μ 9: μ scorbot μ μ . μ μ

μ μ ( μ μ ), .

μ 10: matlab matlab μ μ .

μ 11: μ scorbot ( ). μ μμ (box_

pulses) , μ .

5 3 8

μ 12: μ μ μ matlab .

Page 55: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

55

5 3 9

μ 13: . μ μ .

5.4 μμ

μ μμ Matlab μ μ μ μ .

. . blue μ μ . ( μ )

1 μμ find-picture

μ Matlab μ μ SCORBOT ER-III μ μ .

μ μ μ fabric SCORBOT

ER-III μ μ μ .

2 μμ find-colors

3 μ . Matlab μ μ μ

380X640. μ μμ 3 , μ μ .

3 μμ clean-colors

μμ ‘ ’ μ μ μ .

μ μ μμ μ μ μ μ (0) μ (1)

μ μ . μ μ (x,y). x, y μ

Page 56: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

56

μ μ μμ - μ .

4

μμ find-pulses

μμ μ . μ μ μ μ μ μμ μ μ

μ SCORBOT ER-III. μ Pixel cm , μ

μ μ Pixel μ cm . μ Xzero Yzero μ

μ pixel. μμ μ μ SCORBOT μ μ

. μ μ μ μ μ μ μ μ encoders

SCORBOT ER-III.

5o μμ up-robot

SCORBOT ER-III μ . μ μ μ μμ

.

6 μμ box-pulses

. μ μ SCORBOT ER-III

μ x, y home μ μ μμ 4, .

7 μμ ser-data

μμ Matlab μμ μ μ . μμ

μ μ μ SCORBOT ER-III.

μμ μ matlab. μ μ μ matlab, μμ

, μμ μμ μμ

SCORBOT ER III.

Page 57: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

57

1 μ μ .

2 μ μ μ . μ μ , μ μ μ

μ μ , μ μ μ μ μ

μ

3 SCORBOT ER III. μ , μ μ μ μ : μ . μ μ

DC , μ encoders

4 μ μ μ at90can128. μμ SCORBOT ER III, goPosition

μ μ , μμ goHome μ , μ PWM

5 μμ μ matlab. μ μ μ . μ matlab, μμ

, μμ μμ μμ .

SCORBOT μ μ .

PWM encoders (interrupts), μ μ μ μ μ μ .

μ μ robot μ μ ( μ ),

/ μ (crosstalk) μ μμ .

μ SCORBOT μ , μ .

μ μ μ μ .

Page 58: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

58

μ . μ μ cm μ pixels. μ

pixels μ . . 5 cm. μ μ μ .

μ μ

( y ).

3 μ μ μ software ( μ / MATLAB) μ

μ ( , μ .).

Page 59: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

59

( )

MATLAB

Page 60: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

60

( )

AT90CAN128

Page 61: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

61

( )

SCORBOT ER-III

Page 62: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

62

Page 63: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

63

Page 64: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

64

Page 65: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

65

Page 66: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

66

Page 67: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

67

BLOCK DIAGRAM:

Page 68: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

68

SCHEMATIC:

Page 69: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

69

drivers

μ

/ :

9V , 24V

PC

μ μ

15V dc

5V

dc

Page 70: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

70

SCORBOT ER-3 USER’S MANUAL

TEXT BOOK 1

TEXT BOOK 2

TEXT BOOK 3

TEXT BOOK 4

WWW.MATHWORKS.COM

http://www.plant-management.gr/index.php?id=14943

http://www.liako.gr/scietech/science-technology-robotics/594-2009-06-29-09-55-34.html

http://el.wikipedia.org/wiki/%CE%A1%CE%BF%CE%BC%CF%80%CF%8C%CF%84

http://www.scumdoctor.com/Greek/senior-care/assistive-technology/robotic-technology/Advantages-Of-Robotics.html

Page 71: eclass.hmu.gr · 2011. 2. 23. · 6 1. ! ! 4 9 1 - #. ,1 / .:1/ , & * 21μ

71