질문게시판 > ATmega128 servo motor

TODAY9,233 TOTAL4,429,763
사이트 이용안내
Login▼/회원가입
최신글보기 질문게시판 기술자료 동영상강좌

아두이노 센서 ATMEGA128 PWM LED 초음파 AVR 블루투스 LCD UART 모터 적외선


BASIC4MCU | 질문게시판 | ATmega128 servo motor

페이지 정보

작성자 동콩이 작성일2024-08-07 18:05 조회156회 댓글0건

본문

	

제가 ATmega128 servo motor제어를 하는데 안됩니다.

지금 코드를 보시면 타이머/카운터3을 사용해서 하는데 이제 버튼 2가 눌리면 180도로 설정하고 멈추고 다시 눌리면 0도로 가는 제어를 하고 싶습니다.

그래서 현제 오실로스코프로 pe5번에 나오는 파형을 측정했는데 이제 50hz의 듀티비가 약 5%가 나오고 있습니다. 하지만 한번의 펄스만 있고 싶습니다. 그리고 이제 한번더 누르면 듀티비만 조정이 되야하는데 주파수가 500hz로 변하는 문제도 있습니다 

앞의 버튼0,1은 dc모터 제어입니다 dc모터는 제어에 성공했는데 이제 서보모터가 문제입니다. 만약 버튼을 누르면 이제 서보모터가 지속적으로 돌기만 합니다.

#include <mega128.h>

#include <stdbool.h>

#include <delay.h>

#include <stdint.h>

 

#define OCR3A (*((volatile uint16_t *)0x80)) // Output Compare Register A for Timer/Counter3

#define ICR3  (*((volatile uint16_t *)0x86)) // Input Capture Register for Timer/Counter3

 

bool reverse_mode = false;

bool motor_running = false;

bool servo_angle = false;

bool servo_set = false;

bool pwm_generated = false; // PWM 신호 생성 여부 플래그

unsigned int pwm_duty = 0;

unsigned int pwm_counter = 0;

 

 

// 외부 인터럽트 0 서비스 루틴 - DC 모터 작동 및 방향 전환

interrupt [EXT_INT0] void ext_int0(void)

{

    reverse_mode = !reverse_mode;

    motor_running = true;

    pwm_duty = 700; 

}

 

// 외부 인터럽트 1 서비스 루틴 - DC 모터 정지

interrupt [EXT_INT1] void ext_int1(void)

{

    motor_running = false;

    pwm_duty = 0;

}

 

// 외부 인터럽트 2 서비스 루틴 - 서보모터 180도 및 0도 전환

 

interrupt [EXT_INT2] void ext_int2(void)

{

    servo_angle =! servo_angle;

   if(servo_angle)

    {   delay_ms(500);

        OCR3A = 3500;  // 180도로 변경

    }

    else 

    {   delay_ms(500);

        OCR3A = 1500;  // 0도로 변경

    }

}

 

//외부 인터럽트 3 서비스 루틴 - 서보모터 90도로 초기화

interrupt [EXT_INT3] void ext_int3(void)

{   servo_set =! servo_set;

    if(servo_set)

    {

    OCR3A = 3000;  // 90도로 설정

    }

}

 

 

// 외부 인터럽트 설정 함수

void init_ext_int(void)

{

    DDRD &= 0x0F; 

    PORTD |= 0xF0; 

    EICRA = 0xAA;  // INT0~INT3을 모두 하엣지로 설정                                                               

    EIMSK = 0x0F;  // INT0~INT3 모두 활성화

}

 

// 모터 제어 함수

void control_motor(void)

{

    if (motor_running) 

    {

        if (pwm_counter < pwm_duty) 

        {

            if (reverse_mode) 

            {

                PORTC |= 0x40;  // PC6 켜기

                PORTC &= 0x7F;  // PC7 끄기                                                                                                                                                             

                

            } 

            else 

            {

                PORTC |= 0x80;  // PC7 켜기

                PORTC &= 0xBF;  // PC6 끄기

            }

        } 

        else 

        {

            PORTC &= 0x3F;  // PC7과 PC6 모두 끄기

        }

    } 

    else

    {

        PORTC &= 0x3F;  // 모터가 정지 상태일 때도 PC7과 PC6 모두 끄기

    }

}

 

 

 

// 타이머 1 비교일치 인터럽트 서비스 루틴

interrupt [TIM1_COMPA] void timer1_compa(void)

{

    pwm_counter++;

    if (pwm_counter >= 1023)

        pwm_counter = 0;

    control_motor();

}

 

// 타이머 1 설정 함수

void init_timer1(void)

{

    TCCR1A = 0x00;

    TCCR1B = (1 << WGM12) | (1 << CS11); // CTC 모드, 8분주

    OCR1A = 124; // 약 15.625kHz 인터럽트 주기 (16MHz / 8 / (124 + 1))

    TIMSK |= (1 << OCIE1A); // 타이머1 비교일치 인터럽트 활성화

}

 

void generate_pwm(void)

 

{

    if (!pwm_generated) 

    {

        PORTE |= (1 << PINE3);  // HIGH 상태

        delay_us(1000);         // 1ms 유지 (5% 듀티비)

        PORTE &= ~(1 << PINE3); // LOW 상태

        pwm_generated = true;   // 펄스 생성 완료 표시

    }

}

 

interrupt [TIM3_COMPA] void timer3_compa(void)

{

    generate_pwm(); // 타이머 인터럽트에서 PWM 신호 생성

}

 

 

// 타이머 3 설정 함수

void init_timer3(void)

{

    TCCR3A = (1 << COM3A1) | (1 << WGM31);  // 비반전 PWM, 모드 14 (고속 PWM)

    TCCR3B = (1 << WGM33) | (1 << WGM32) | (1 << CS31);  // 모드 14, 프리스케일러 8

    OCR3A = 2500; // 초기 서보 위치 90도

    ICR3 = 39999;  // TOP 값: 20ms 주기 (16MHz / 8 / (39999 + 1) = 50Hz)

    DDRE |= (1 << PINE3); // PE3 핀을 출력으로 설정

}

 

 

void main(void)

{

    DDRC |= 0xC0;  // PC7과 PC6를 출력으로 설정

    PORTC &= 0x3F; // PC7과 PC6 초기에 끄기 (모터 정지)

    

    pwm_counter = 0; // PWM 카운터 초기화

    

    init_ext_int(); // 외부 인터럽트 초기화

    init_timer1(); // 타이머1 초기화

    init_timer3(); // 타이머3 초기화

    #asm("sei") // 전역 인터럽트 활성화

    

    

    while(1)

    {

        generate_pwm();    

    }

}

  • BASIC4MCU 작성글 SNS에 공유하기
  • 페이스북으로 보내기
  • 트위터로 보내기
  • 구글플러스로 보내기

댓글 0

조회수 156

등록된 댓글이 없습니다.

질문게시판HOME > 질문게시판 목록

MCU, AVR, 아두이노 등 전자공학에 관련된 질문을 무료회원가입 후 작성해주시면 전문가가 답변해드립니다.
ATMEGA128PWMLED초음파
아두이노AVR블루투스LCD
UART모터적외선ATMEGA
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
공지 MCU, AVR, 아두이노 등 전자공학에 관련된 질문은 질문게시판에서만 작성 가능합니다. 스태프 19-01-15 23991
공지 사이트 이용 안내댓글[31] master 17-10-29 38110
질문 아두이노 및 전기배선 작동이 안되어 해결 부탁드립니다 첨부파일 호떡아 24-09-14 80
답변 답변글 답변 : 아두이노 및 전기배선 작동이 안되어 해결 부탁드립니다 master 24-09-14 135
질문 USB host하고 Stop모드를 같이 쓰려는데댓글[1] 이미지 라칸 24-09-12 178
질문 아두이노 압력 센서로 LED 불빛 들어오게 할려고 하는데... 이미지첨부파일 윤시기 24-09-12 312
답변 답변글 답변 : 아두이노 압력 센서로 LED 불빛 들어오게 할려고 하는데... 이미지 master 24-09-12 204
질문 esp32 배터리 잔량 공부중입니다..댓글[6] 펌린이 24-09-06 666
답변 답변글 답변 : esp32 배터리 잔량 공부중입니다.. 이미지 master 24-09-07 64
질문 ads로 adc값을 읽는데댓글[1] 라칸 24-09-05 102
질문 stm32 절전모드에 대해서댓글[2] 라칸 24-08-29 117
질문 아두이노 우노보드로 스마트팜 만들려고 하는데 문제가 있어요댓글[4] 부러진명검 24-08-28 368
질문 아두이노 블루투스 통신댓글[3] 이미지첨부파일 찌릿공돌이 24-08-27 259
질문 stm32에서 USB에 파일 생성 및 저장을 하려는데댓글[1] 이미지 라칸 24-08-23 243
질문 STM32 1개의 핀으로 ADC, DAC 사용 가능 여부댓글[4] aaahhhj 24-08-21 393
질문 회로 수정 질문..댓글[3] 이미지 소정이 24-08-21 257
질문 아두이노에서 stm32 그래프 파형 보려고 하는데 발생하는 오류댓글[1] aaahhhj 24-08-19 192
질문 님들 센서를 사용해서 adc값을 읽으려는데댓글[1] 라칸 24-08-13 201
현재글 ATmega128 servo motor 동콩이 24-08-07 157
답변 답변글 답변 : ATmega128 servo motor댓글[2] master 24-08-07 403
질문 체성분 분석하는 센서를 어떻게 구해야할까요?댓글[2] 제작왕초보 24-08-02 360
질문 LED와 FND의 출력이 제가 생각한대로 나오지 않아요.댓글[4] 킹왕짱 24-07-24 791
질문 STM32F429ZIT6보드와 lcm1602 이용한 알람시계 질문 (사용자 지정 알람 값에 알람 인터럽트 반… aaahhhj 24-07-24 130
답변 답변글 답변 : STM32F429ZIT6보드와 lcm1602 이용한 알람시계 질문 (사용자 지정 알람 값에 알람 인…댓글[1] master 24-07-24 186
질문 16bit DAC와 ADC 연결댓글[1] JMLew 24-07-19 211
질문 아두이노 초음파센서 연결 + 컴퓨터 연결 제발 도와주세요댓글[1] 이미지첨부파일 pinkpong 24-07-14 314
질문 아두이노 여러 센서 연결댓글[4] 이미지첨부파일 공수백자 24-07-09 986
질문 기어드 모터 외부인터럽트 사용하여 1초 동안 펄스 세는 법댓글[3] 바밤 24-07-04 547
질문 STM32F429ZIT6 rtc alarm 인터럽트 i2c lcd에 구현하는 방법댓글[5] aaahhhj 24-06-29 896
질문 Atmega128 LCD 출력이 나오지 않습니다, 코드 확인 부탁드립니다. 이미지첨부파일 코드에막혀 24-06-25 217
게시물 검색

2022년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2021년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2020년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2019년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2018년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
Privacy Policy
MCU BASIC ⓒ 2020
모바일버전으로보기