AN2350 datasheet(37/41 Pages) STMICROELECTRONICS

부품명	AN2350

상세설명	Guidelines for the control of a multiaxial planar robot with ST10F276

PDF	41 Pages

Scroll/Zoom	100%

제조업체	STMICROELECTRONICS [STMicroelectronics]

홈페이지	http://www.st.com

Logo

37 / 41 page

Control algorithm

AN2350

37/41

Now the shoulder is controlled in its home position, the same procedure is executed for the

elbow, using the Capture unit CC22. The control of the shoulder ensures that during the

home procedure for the elbow there's no movement of the shoulder.

The scheme below shows the homing procedure.

Figure 30.

The homing procedure

Read Absolute Encoder

of the shoulder and

enable interrupt CC16

while(!home_position_sh)

{

Move shoulder with fixed PWM

}

Stop the shoulder

Reset incremental encoder

of the shoulder (T2)

Enable interrupt for control

algorithm, and disable

interrupt CC16

sh_pulses_desired

Read Absolute Encoder

of the elbow and enable

interrupt CC22

while(!home_position_elb)

{

Move elbow with fixed PWM

}

Stop the elbow

Reset incremental encoder

of the elbow (T4)

Disable interrupt CC22

elb_pulses_desired

Read Absolute Encoder

for the shoulder

This is the right

transition?

ISR for the

shoulder

home_position_sh=true;

Exit

Control

Algorithm

Read Absolute Encoder

for the elbow

ISR for the

elbow

This is the right

transition?

home_position_elb=true;

Exit

AN2350 데이터시트(PDF) 37 Page - STMicroelectronics

AN2350 데이터시트(HTML) 37 Page - STMicroelectronics

Html Pages

1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41

데이터시트 다운로드

링크 URL