59 lines
1.1 KiB
C++
59 lines
1.1 KiB
C++
#define F_CPU 8000000UL
|
|
#include<avr/io.h>
|
|
#include <util/delay.h>
|
|
#include "servo.h"
|
|
|
|
int main()
|
|
{
|
|
servo::init();
|
|
//Configure TIMER1
|
|
// TCCR1A|=(1<<COM1A1)|(1<<COM1B1)|(1<<WGM11); //NON Inverted PWM
|
|
// TCCR1B|=(1<<WGM13)|(1<<WGM12)|(1<<CS11)|(0<<CS10); //PRESCALER=1 MODE 14(FAST PWM)
|
|
|
|
// ICR1=19999; //fPWM=50Hz (Period = 20ms Standard).
|
|
|
|
// DDRD|=(1<<PD4)|(1<<PD5); //PWM Pins as Out
|
|
|
|
while(1)
|
|
{
|
|
// for(int i = 1000; i < 2000; i++) {
|
|
// OCR1A = i;
|
|
// _delay_ms(1);
|
|
// }
|
|
|
|
// for(int i = 2000; i > 999; i--) {
|
|
// OCR1A = i;
|
|
// _delay_ms(1);
|
|
// }
|
|
|
|
servo::pos(1000);
|
|
_delay_ms(1000);
|
|
servo::pos(2000);
|
|
_delay_ms(1000);
|
|
// OCR1A=0; //0 degree
|
|
// _delay_ms(1000);
|
|
|
|
// OCR1A=600; //45 degree
|
|
// _delay_ms(1000);
|
|
|
|
// OCR1A=950; //90 degree
|
|
// _delay_ms(1000);
|
|
|
|
// OCR1A=1425; //135 degree
|
|
// _delay_ms(1000);
|
|
|
|
// OCR1A=1900; //180 degree
|
|
// _delay_ms(1000);
|
|
|
|
// OCR1A=1425; //135 degree
|
|
// _delay_ms(1000);
|
|
|
|
// OCR1A=950; //90 degree
|
|
// _delay_ms(1000);
|
|
|
|
// OCR1A=650; //45 degree
|
|
// _delay_ms(1000);
|
|
|
|
}
|
|
return 0;
|
|
} |