Функция настройки PWM void PWM_pow int Motor1 short int Motor1_directi

 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
//Функция настройки PWM.
void PWM_pow(int Motor1,short int Motor1_direction,int Motor2,short int Motor2_direction)
{
cli();
if (Motor1_direction)
{
Enable (PORTC,3);
Disable (PORTC,5);
}//PC5=0, PC3=1
else
{
Enable (PORTC,5);
Disable (PORTC,3);
};
if (Motor2_direction)
{
Enable (PORTD,7);
Disable (PORTC,1);
}//PC1=1, PD7=0
else
{ Enable (PORTC,1);
Disable (PORTD,7);
};
OCR0A=(int)(Max_PWM_Const*(float)Motor1);
OCR0B=(int)(Max_PWM_Const*(float)Motor2);
sei();
}
//——————————————————————