모터 > 8핀(GPIO3 + 16비트 PWM 5)으로 서보모터 40개 구동

BASIC4MCU | 모터 | 서보모터 | 8핀(GPIO3 + 16비트 PWM 5)으로 서보모터 40개 구동

페이지 정보

작성자 키트 작성일2017-09-05 17:18 조회2,477회 댓글0건

https://www.basic4mcu.com/bbs/board.php?bo_table=gesiyo11&wr_id=181

본문

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
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59 //#define CVAVR // 코드비젼 사용자는 제일 앞에 막은 것을 삭제하면 됩니다.
//
#ifdef CVAVR
  #include <mega128.h>
  #include <delay.h>
#else
  #define  F_CPU 16000000UL  // 16 MHz
  #define  delay_ms(x) _delay_ms(x)
  #include <avr/io.h> //16MHz
  #include <util/delay.h>
  #include <avr/interrupt.h>
#endif
//
volatile unsigned int pwm[8][5]={
  {3600,2500,2500,2500,2500},
  {2500,2500,2500,2500,2500},
  {2500,2500,2500,2500,2500},
  {2500,2500,2500,2500,2500},
  {2500,2500,2500,2500,2500},
  {2500,2500,2500,2500,2500},
  {2500,2500,2500,2500,2500},
  {2500,2500,2500,2500,2500}
};
volatile unsigned char n=0;
//
#ifdef CVAVR
  interrupt [TIM3_COMPC] void timer3_compc_isr(void){
#else
  ISR(TIMER3_COMPC_vect){
#endif
  PORTA=n;
  OCR1A=pwm[n][0];     OCR1B=pwm[n][1];
  OCR1CH=pwm[n][2]>>8; OCR1CL=pwm[n][2]&0xFF;
  OCR3AH=pwm[n][3]>>8; OCR3AL=pwm[n][3]&0xFF;
  OCR3BH=pwm[n][4]>>8; OCR3BL=pwm[n][4]&0xFF;
  if(++n>7)n=0;
}
//
#ifdef CVAVR
  void main(void){
#else
  int main(void){
#endif
  int i;
  unsigned char k;
  DDRA=0x07;      DDRB=0xE0;     DDRE=0x18;
  ICR1=4999;      ICR3H=4999>>8; ICR3L=4999&0xFF; // 20ms/8=2.5ms
  OCR3CH=4800>>8; OCR3CL=4800&0xFF;
  TCCR1A=0xAA;    TCCR3A=0xA2;
  TCCR1B=0x1A;    TCCR3B=0x1A;
  ADMUX=0x40;     ADCSRA=0xE7;
  ETIMSK=2;       SREG=0x80;
  while(1){
    for(k=0;k<8;k++){
      ADMUX=0x40|k; delay_ms(1); i=ADCW;
      pwm[k][0]=(int)((float)i*3600.0/1023.0)+1200; // 0~1023 => 1200~4800
    }
  }
}
Colored by Color Scripter cs

OCR3C 인터럽트는 PWM 값을 갱신 하는데 사용합니다.

AVR 리셋 기간 동안에 엉뚱한 출력이 나가지 않도록 회로를 보완한다면
AVR 5개의 PWM출력핀에 10K 풀업저항을 달아주면 되겠습니다.

등록된 댓글이 없습니다.

모터 목록
	제목	작성자	작성일	조회
공지	MCU, AVR, 아두이노 등 전자공학에 관련된 질문은 질문게시판에서만 작성 가능합니다.	스태프	19-01-15	21187
공지	사이트 이용 안내댓글[29]개	master	17-10-29	34933
190	서보모터 [UART 마스터-슬레이브] ADC 3채널 -> 서보모터 3개	키트	17-09-05	2317
189	서보모터 RC서보모터 솔라 트래커	키트	17-09-05	2556
188	서보모터 UART로 RC서보모터 구동 - 1채널	키트	17-09-05	2473
187	서보모터 가변저항으로 RC서보모터 구동 - 2채널	키트	17-09-05	2489
186	서보모터 11핀(GPIO 5 + 16비트 PWM 6)으로 서보모터 96개 구동	키트	17-09-05	2403
185	서보모터 9핀(GPIO3 + 16비트 PWM 6)으로 서보모터 48개 구동	키트	17-09-05	2509
184	서보모터 3핀(GPIO 1 + 16비트 PWM 2)으로 서보모터 32개 구동	키트	17-09-05	2371
183	서보모터 3핀(GPIO 1 + 16비트 PWM 2)으로 서보모터 16개 구동	키트	17-09-05	2258
182	서보모터 2핀(GPIO 1 + 16비트 PWM 1개)으로 서보모터 8개 구동	키트	17-09-05	2438
현재글	서보모터 8핀(GPIO3 + 16비트 PWM 5)으로 서보모터 40개 구동	키트	17-09-05	2478
180	서보모터 RC수신기로부터 8채널 PWM 신호 입력 - CPPM	키트	17-09-05	2829
179	서보모터 RC수신기로부터 8채널 PWM 신호 입력 - PPM	키트	17-09-05	3236
178	서보모터 ATmega128 - 53개의 서보모터 구동	키트	17-09-05	3220

모터 목록

제목

작성자

작성일

조회

공지

MCU, AVR, 아두이노 등 전자공학에 관련된 질문은 질문게시판에서만 작성 가능합니다.

스태프

19-01-15

21187

공지

사이트 이용 안내댓글[29]개