forked from Watchdog069/AVR-Codes
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathattiny13_PWM_ServoMotor.c
60 lines (54 loc) · 1.16 KB
/
attiny13_PWM_ServoMotor.c
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
60
/*
* AVRGCC7_ATTINY_ServoMotor.c
*
* Created: 29-09-2020 21:41:56
* Author: user
*/
#include <avr/io.h>
#include <util/delay.h>
#define F_CPU 9600000
void setPin(int pin,int state){ //port=A,B,C,D. pin 0-7. state 0(input) or 1(output).
if(state==1)
DDRB |= (1<<pin);
else
DDRB &= ~(1<<pin);
}
void digitalWrite(int pin,int state){ //port=A,B,C,D. pin 0-7. state 0 or 1.
if(state==1)
PORTB |= (1<<pin);
else
PORTB &= ~(1<<pin);
}
void pwm(int pin,int num){
TCCR0B |= (1<<CS00)|(1<<CS01);//prescalar /64
switch(pin){
case 0:
TCCR0A |= (1<<WGM01)|(1<<WGM00)|(1<<COM0A1);//fast pwm, non inverted
setPin(0,1);
OCR0A=num;
break;
case 1:
TCCR0A |= (1<<WGM01)|(1<<WGM00)|(1<<COM0B1);//fast pwm, non inverted
setPin(1,1);
OCR0B=num;
break;
}
}
void servo(int pin, int angle){ //prescalar was 64, so pwm freq is 9.6MHz/(256*64)=586hz.
pwm(pin,(int)angle*0.2); //180deg -> 36, so 36/180=0.2
}
int main(void)
{
while(1)
{
for(int i=0;i<=180;i++){
servo(0,i);
_delay_ms(20);
}
for(int i=180;i>=0;i--){
servo(0,i);
_delay_ms(20);
}
//TODO:: Please write your application code
}
}