Автоматическое включение фар при запуске двигателя

Код:
program pwr1;
// версия с задержками на таймере 1.6
// исправлена ошибка с запуском ламп в момент включения зажигания
// добавлено отключение ламп через 4 минуты
{$NOSHADOW}
{ $WG} {global Warnings off}
{$OPTIMISE}

Device = mega8, VCC=5;
{ $BOOTRST $01C00} {Reset Jump to $01C00}

Import SysTick, WatchDog, SoftPWM, FreqCount;

{From System Import LongInt;}


Define
ProcClock = 16000000; {Hertz}
SysTick = 2; {msec}
WatchDog = msec2000; {presc = 7}
StackSize = $0032, iData;
FrameSize = $0032, iData;
FreqTimer = Timer1; {use Timer1}
SoftPWMport = PortD; {use PortB for PWM output}
SoftPWMtimer = Timer2, 10; {use timerx, PWM cycle time msec}
SoftPWMres = 100; {PWM resolution is 100 points}
SoftPWMchans = 1, 0; {x channels, bity is the first bit}

Implementation

{$IDATA}

{--------------------------------------------------------------}
{ Type Declarations }

type


{--------------------------------------------------------------}
{ Const Declarations }

{--------------------------------------------------------------}
{ Var Declarations }
{$IDATA}
var
i: word;
Timer : SysTimer; // Таймер для отсчета временных интервалов
TimeSpd : word; // Длина импульса по базе замера
PulseFlag: boolean; // Флаг замера количества импульсов
CountP, CountN: word; // Количество положительных и нулевых импульсов по базе замера
StopCount: word; // Счетчик циклов переполнения

const
SpeedOn : byte = 6; // Скорость при которой включится DRL
SpeedMin : byte = 70; // Скорость с которой начинает нарастать мощность DRL
SpeedMax : byte = 95; // Скорость при которой DRL выйдет на максимальную мощность
SpeedLimit: byte = 255; // Лимит скорости
TimeOn : word = (60000 div SpeedOn); // Длина имульса для включения DRL
TimeMin : word = (60000 div SpeedMin); // Длина импульса для нижней границы скорости
TimeMax : word = (60000 div SpeedMax); // Длина импульса для верхней границы скорости
TimeLimit : word = (60000 div SpeedLimit); // Длина импульса для лимита скорости
PWMOff : word = 0; // Скважность DRL при отключении света
PWMStop: word = 30; // Скважность DRL если машина стоит
PWMMin : word = 70; // Минимальная скважность DRL
PWMMid : word = 80; // Средняя скважность DRL
PWMMax : word = 95; // Максимальная скважность DRL
PWMStd : word = 100; // Cкважность DRL для штатного света
PWMDelta : word = ((PWMMax - PWMMin)*100) div (TimeMin - TimeMax); // 100% приращения PWM на единицу длины импульса
StopCycles : word = 20; // Количество циклов ожидания для перехода в режим PWMStop 30 сек *1,5
OffCycles : word = 200; // Количество циклов ожидания для перехода в режим PWMOff 300 сек

{--------------------------------------------------------------}
{ functions }

procedure InitPorts;
begin
DDRB := %11111100;
PortB := %00000000;
DDRC := %11111111;
PortC := %00000000;
DDRD := %11111111;
PortD := %00000001;
end InitPorts;

procedure SetPWM(NewPWM: byte; DelayPWM: word);
// Плавная установка PWM с шагом 5% и задержкой в цикле
var
D1, D2, i: byte;
begin
if SoftPWM1 = NewPWM then
return;
endif;
DelayPWM := DelayPWM div 2;
if SoftPWM1 > NewPWM then
D1 := (SoftPWM1 - NewPWM) div 5;
D2 := (SoftPWM1 - NewPWM) mod 5;
for i := 1 to D1 do
SoftPWM1 := SoftPWM1 - 5;
SetSysTimer (Timer, DelayPWM);
repeat until isSysTimerZero(Timer);
WatchDogTrig;
endfor;
SoftPWM1 := SoftPWM1 - D2;
SetSysTimer (Timer, DelayPWM);
repeat until isSysTimerZero(Timer);
endif;

if SoftPWM1 < NewPWM then
D1 := (NewPWM - SoftPWM1) div 5;
D2 := (NewPWM - SoftPWM1) div 5;
for i := 1 to D1 do
SoftPWM1 := SoftPWM1 + 5;
SetSysTimer (Timer, DelayPWM);
repeat until isSysTimerZero(Timer);
WatchDogTrig;
endfor;
SoftPWM1 := SoftPWM1 + D2;
SetSysTimer (Timer, DelayPWM);
repeat until isSysTimerZero(Timer);
endif;
end;

procedure flash;
var temp: byte;
begin
temp:=SoftPWM1;
SoftPWM1:=0;
mdelay(100);
SoftPWM1:=100;
mdelay(100);
SoftPWM1:=temp;
end;

{--------------------------------------------------------------}
{ Main Program }
{$IDATA}

begin
InitPorts;
StopCount := 0;
EnableInts;
SoftPWM1 := byte(PWMOff);
loop
WatchDogStart;
FreqCountRestart;
if PinB.1 = false then // Если штатный свет включен, то обрабатываем режим штатного света
if SoftPWM1 <> byte(PWMStd) then // Если режим штатного света ещё не включен,
SetPWM(byte(PWMStd), 50); // то включаем его
else
SetSysTimer (Timer, 250); // Если режим уже включен, то пауза 0,5 сек
repeat until isSysTimerZero(Timer);
endif;
else // Если штатный свет отключен, то обрабатываем ДС
SetFreqCountMode(TTimeBase100ms); // Начинаем замер периода по базе 100 мсек
FreqCountRestart;
SetSysTimer (Timer, 251); // Задержка главного цикла 502 мсек
repeat until isSysTimerZero(Timer); //
if SemaStat(FreqCountSema) <> 0 then // Замер произошел
TimeSpd := GetTimeCounter;
if GetFreqCountOvrFlow <> 0 then // Переполнение при замере по базе 100 мсек - машина едет медленнее 6 км/ч
SetFreqCountMode(TPulseBase1s ); // Начинаем замер количества импульсов по базе 1 сек
FreqCountRestart;
SetSysTimer (Timer, 501); // Задержка главного цикла 1002 мсек
repeat until isSysTimerZero(Timer); //
if SemaStat(FreqCountSema) <0> 0 then
StopCount:=0;
if SoftPWM1 <byte>= byte(PWMStop)) then // Штатный свет выключен, PWM больше PWM стоящей машины ???
inc(StopCount);
if (StopCount = StopCycles) and (SoftPWM1 > byte(PWMStop)) then
SetPWM(byte(PWMStop), 50);
endif;
if (StopCount = OffCycles) and (SoftPWM1 = byte(PWMStop)) then
SoftPWM1 := byte(PWMOff);
StopCount := 0;
endif;
endif;
endif;
else
if (PinB.1 = true) and (SoftPWM1 >= byte(PWMStop)) then // Штатный свет выключен, PWM больше PWM стоящей машины ???
inc(StopCount);
if (StopCount = StopCycles) and (SoftPWM1 > byte(PWMStop)) then
SetPWM(byte(PWMStop), 50);
endif;
if (StopCount = OffCycles) and (SoftPWM1 = byte(PWMStop)) then
SoftPWM1 := byte(PWMOff);
StopCount := 0;
endif;
endif;
endif;
else
StopCount := 0;
SetSysTimer (Timer, 501); // Задержка главного цикла 1002 мсек
repeat until isSysTimerZero(Timer);
// Скорость выше или равна верхней границе
if (TimeSpd <TimeMax>= TimeLimit) and (SoftPWM1 <byte> TimeMax) and (TimeSpd < TimeMin) and (SoftPWM1 <> byte(PWMMid)) then SetPWM(byte(PWMMid), 50); endif;
// Скорость выше или равна границе включения и ниже или равна нижней границы
if (TimeSpd <TimeOn>= TimeMin) and (SoftPWM1 <byte>= byte(PWMStop)) then // Замер по базе 100 мсек не произошел, штатный свет выключен, PWM больше PWM стоящей машины ???
inc(StopCount);
if (StopCount = StopCycles) and (SoftPWM1 > byte(PWMStop)) then
SetPWM(byte(PWMStop), 50);
endif;
if (StopCount = OffCycles) and (SoftPWM1 = byte(PWMStop)) then
SoftPWM1 := byte(PWMOff);
StopCount := 0;
endif;
endif;
SetSysTimer (Timer, 501); // Задержка главного цикла 1002 мсек
repeat until isSysTimerZero(Timer); //
endif;
endif;
WatchDogTrig;
endloop;
end pwr1.