BASIC4MCU | 질문게시판 | 답변 : atmega128 서보모터3개연결
페이지 정보
작성자 master 작성일2018-12-08 17:42 조회7,749회 댓글2건
https://www.basic4mcu.com/bbs/board.php?bo_table=gac&wr_id=6562
본문
// MCU BASIC: https://www.basic4mcu.com// DateTime : 2018-12-08 오후 5:47:51// by Ok-Hyun Park//#define F_CPU 16000000L#include <avr/io.h>#include <util/delay.h>//void sv1(int a){ OCR1A=a*19+3000; } // PB5 // a=-90~+90void sv2(int a){ OCR1B=a*19+3000; } // PB6void sv3(int a){ OCR1C=a*19+3000; } // PB7void sv4(int a){ OCR3A=a*19+3000; } // PE3 // a=-90~+90void sv5(int a){ OCR3B=a*19+3000; } // PE4void sv6(int a){ OCR3C=a*19+3000; } // PE5//int main(void){DDRB=0xE0; //OC1A,B,C 출력DDRE=0x38; //OC3A,B,C 출력OCR1A=OCR1B=OCR1C=3000; TCCR1A=0xAA; TCCR1B=0x1A; ICR1=39999;OCR3A=OCR3B=OCR3C=3000; TCCR3A=0xAA; TCCR3B=0x1A; ICR3=39999;while(1){if((PINA&2)){sv1( 0); sv2( 45); sv3( 90); sv4( 0); sv5( 45); sv6( 90); _delay_ms(3000);sv1( 45); sv2( 90); sv3( 45); sv4( 45); sv5( 90); sv6( 45); _delay_ms(3000);sv1( 90); sv2( 45); sv3( 0); sv4( 90); sv5( 45); sv6( 0); _delay_ms(3000);sv1( 45); sv2( 0); sv3(-45); sv4( 45); sv5( 0); sv6(-45); _delay_ms(3000);sv1( 0); sv2(-45); sv3(-90); sv4( 0); sv5(-45); sv6(-90); _delay_ms(3000);sv1(-45); sv2(-90); sv3(-45); sv4(-45); sv5(-90); sv6(-45); _delay_ms(3000);sv1(-90); sv2(-45); sv3( 0); sv4(-90); sv5(-45); sv6( 0); _delay_ms(3000);sv1(-45); sv2( 0); sv3( 45); sv4(-45); sv5( 0); sv6( 45); _delay_ms(3000);}}}
서보모터 6개 구동 예제입니다.
동작이 되는 핀을 골라서 사용하세요
댓글 2
조회수 7,749로봇님의 댓글
로봇 작성일정말 감사합니다. 천사이신가요..
rarety님의 댓글
rarety 작성일저기 혹시 회로도 알수있나요?ㅠㅠㅠ