tepper Motor 제어 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 1
Agenda 1. 스텝모터기초 2. Full tep 제어 (1상/2 상제어 ) 3. Half tep 제어 (1-2 상제어 ) 4. Micro tepping 제어 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 2
1. 스텝모터기초 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 3
DC 모터 vs 스텝모터 제어에의해미리정해진 step angle 만큼회전 디지털모터 tep angle : Angle/step DC Motor (Analog) tepper Motor (Digital) 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 4
스텝모터의장점 낮은가격 오픈루프제어에이상적 피드백이필요하지않음센서가필요하지않음스템을카운팅하는것만으로제어 기계적인브레이크가필요하지않다. 저속에서의토크가 DC 모터보다우수함. 위치제어애플리캐이션에우수 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 5
energize 구조 고정자 (tator/phase) 권선 회전자 (Rotator) 자화 비자화 모터의권선에전력이공급되면자기필드가생성되어회전자가회전한다. Phases energize 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 6
스텝모터의분류 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 7
회전자의종류에따른분류 영구자석형 (Permanent Magnetic, PM) 가변릴럭턴스형 (Variable Reluctance, VR) 연철기어형태의회전자 하이브리드타입 Mixed type (PM & VR) 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 8
영구자석형스텝모터 영구자석형회전자 해상도증가방법 - 극 (pole) 추가 - 상 (Phase) 추가 Rotor 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 9
비자화회전자 ( 연철 ) 가변릴럭턴스형스텝모터 해상도증가방법 상 (Phase) 추가 릴럭턴스에의해회전 릴럭턴스 ( 자기저항 ) : 자기회로에서자기력선속 ( 磁氣力線束 ) 에대한저항력. 자기회로의길이에비례하고그단면적, 투자율 ( 透磁率 ) 에반비례한다. oft-iron Rotor 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 1
하이브리드스텝모터 PM + VR TATOR WIDIG Pole Rotator slot Pole Rotator lot Pole Pole Rotator lot Rotator lot ide View 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 11
권선의형태에따른분류 Unipolar type Bipolar type 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 12
Unipolar vs Bipolar Bipolar 양방향전류 Full winding energization 1 3 Bipolar 2 4 Unipolar : center 탭추가 단방향전류 Half winding energization Unipolar 3 1 2 4 5 6 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 13
2. Full tep 제어 (1 상 ) 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 14
tepping tep Angle Full tep Half tep Microstep peed (RPM) 결정요인 1 회전당필요한스텝의수 스텝제어빈도 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 15
Bipolar 스텝모터풀스텝 1 상 제어 Winding B tep 1 2 3 4 Winding A A A Winding B B B PORTB 1 1 1 1 1 PIC Microcontroller RB RB1 RB2 RB3 RB4 RB5 RB6 RB7 1 1 1 1 Motor Drive B B current A Winding current A A 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 16
풀스텝 1 상 제어 Voltage equence 4 tep A A B B TEP 1 TEP 2 TEP 3 TEP 4 TEP 1 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 17
peed (RPM) 회전당스텝수 (steps/rev.) = 36 / [# Angle/step] example 36 / 9 = 4 스텝 / 회전 PP (Pulses Per econd) = [ target RPM / 6 sec] x 회전당스텝수 example [ 12 RPM / 6 sec ] x ( 4 steps/revolution ) = 8 [pulses/second] 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 18
Winding B 제어타이밍 PP를통해타이머인터럽트타이밍을계산 Motor control pulse generate at Timer IR PIC Microcontroller Timer RB RB1 RB2 RB3 RB4 RB5 Motor Drive B B RB6 RB7 A Winding A A 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 19
Main routine Full tep 1 상통전 알고리즘 TMR Interrupt Initialization TRID PORTD Timer interrupt TMR Value Pulse_Counter = tep equence: TEP[1] = 1 xxxx TEP[2] = 1 xxxx TEP[3] = 1 xxxx TEP[4] = 1 xxxx Pulse_Counter++ Pulse_Counter > 4? O PORTD= TEP[ i ] YE Pulse_Counter = ** i = Pulse_Counter Loop return 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 2
Bipolar 스텝모터풀스텝 2 상 제어 Winding B tep 1 2 3 4 권선 A A A A A 권선 B B B B B PIC Microcontroller RB RB1 RB2 RB3 RB4 RB5 RB6 RB7 1 1 Motor Drive PORTB 1 1 1 1 1 B B 1 Winding current A 1 A A current 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 21
풀스텝 2 상 Voltage equence 4tep A A B B TEP 1 TEP 2 TEP 3 TEP 4 TEP 1 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 22
Main routine 풀스텝 2 상 알고리즘 TMR Interrupt Initialization TRID PORTD Timer interrupt TMR Value Pulse_Counter = tep equence : TEP[] = 11 xxxx TEP[1] = 11 xxxx TEP[2] = 11 xxxx TEP[3] = 11 xxxx Pulse_Counter++ Pulse_Counter > 4? O PORTD = TEP[ i ] YE Pulse_Counter = ** i = Pulse_Counter Loop return 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 23
5. Anti-Resonance 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 24
Pulse Pulse Angle of Rotation 안티레조넌스 (Anti-resonance) Overshoot Ringing 1.a A 2.b B 1.b A 2.a B 18 9 Ringing Time 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 25
Pulse Pulse Angle of Rotation 안티레조넌스 (Anti-resonance) 최악의경우 Miss tep 발생 1.a A 2.b B 2.a B 18 9 1.b A Time 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 26
5. Half 스텝제어 (1-2 상 ) 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 27
Half tepping 1 상 + 2 상 회전각의해상도증가 Anti-resonance 감소 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 28
Winding B Bipolar 스텝모터하프스텝제어 스텝 1 2 3 4 5 6 7 8 권선 A A A A A A A 권선 B B B B B B B PORTB 1 1 1 1 1 PIC Microcontroller RB RB1 RB2 RB3 RB4 RB5 RB6 RB7 1 1 1 1 Motor Drive B B current A Winding current A A 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 29
Bipolar 스텝모터하프스텝 Voltage equence 주기 : 8 스텝 A A B B ½ ½ ½ ½ ½ TEP 1 TEP 2 TEP 3 TEP 4 TEP 1 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 3
하프스텝알고리즘 Main routine Initialize PORTD, TMR Pulse_Counter = tep equence: TEP[1] = 1 xxxx TEP[2] = 11 xxxx TEP[3] = 1 xxxx TEP[4] = 11 xxxx TEP[5] = 1 xxxx TEP[6] = 11 xxxx TEP[7] = 1 xxxx TEP[8] = 11 xxxx Loop TMR Interrupt Pulse_Counter++ Pulse_Counter > 8? O PORTD = TEP[ i ] return YE Pulse_Counter = ** i = Pulse_Counter 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 31
바이폴라스텝모터제어회로 PORTB 1 1 1 1 1 1 1 1 Vsupply RB2 RB3 RB1 RB RB7 Winding RB6 RB4 Winding RB5 A B A A B B 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 32
4. Microstepping 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 33
해상도증가 Microstepping 풀스텝 < 하프스텝 < 마이크로스텝노이즈감소 Anti-resonance 문제대응 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 34
current Micro stepping Current Wave 권선 A 에서권선 B 로의단계적인전류의변화 ine and Cosine wave form winding A winding B 1 2 3 4 1 2 3 4 teps 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 35
Gate Voltage Coil Current Microstepping 구현 PWM Duty Cycle control Current control on coil V+ current O HIGH IMAX PWM Time 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 36 Time
Coil Current Microstepping 구현 V+ V+ ½ 1 1½ 2 2½ 3 3½ 4 Time (tep) 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 37
Microsteps vs. tep Rate Microsteps Increase eed tep rate Increase umber of Microsteps tep Rate Factor for Equivalent Full tep RPM Full tep/ 4 tep Rate x 4 Full tep/ 8 tep Rate x 8 Full tep/16 tep Rate x 16 Full tep/32 tep Rate x 32 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 38
Microstep Look-Up Table Microstep Winding A (current) Winding B (current) PWM1 DC PWM2 DC +1 +in 5.6 1% 9.8% 1 +1 +in 11.25 1% 2% 2 +1 +in 16.8 1% 29% 3 +1 +in 22.5 1% 38% 4 +1 +in 28 1% 47% 5 +1 +in 33.75 1% 56% 6 +1 +in 39 1% 63% 7 +1 +in 45 1% 71% 8 +1 +in 5.6 1% 77% 9 +1 +in 56.25 1% 83% 1 +1 +in 61.8 1% 88% 11 +1 +in 67.5 1% 93% 12 +1 +in 73.1 1% 95.6% 13 +1 +in 78.75 1% 98% 14 +1 +in 84.35 1% 99.5% 15 +1 +in 9 1% 1% 32 teps/2 = 16 teps 9 /16 teps = 5.625 /tep in 5.6 =.98 or 9.8% Duty Cycle 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 39
Microstepping 하나의권선에서다른권선으로전류가점진적으로변화함 PWM 듀티사이클의변화를통해구현됨 추가적인퍼포먼스 (performance) 필요 ine function Lookup Table 활용 효과적인 Anti-resonances 솔루션 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 4
Thank You!! 28 Microchip Technology Incorporated. All Rights Reserved. tepper Motor Control lide 41