Нужна Помощь С Адаптивным Светом

[Oleg-galaxy]

История такова. На автомобиле стоят сфары с регулировкой вправо-влево на шаговых моторчиках. Драйвер и контроллер на 2313 и транзах. Сейчас все работает в ручном режиме, т.е. нажал на кнопку 1 фара поворачивается вправо, на кн. 2 - влево, на кн. 3 -вправо вторая , на кн.4 влево вторая.

Вот так.Возникла идея прицепить на руль энкодер и с него брать угол поворота. Есть центр, фары светят прямо. Поворачиваем руль влево больше чем на 0,5 оборота(200 импульсов) - левая фара поворачивается тоже(нажимаем кн2 на 2 сек). Вернули руль в центр- фара вернулась на прежнее место(нажимаем кн1 на 2 сек). Аналогично с правой. В баскоме прикинул програмку на меге 8 для отдельных фар, сначала такая идея была, теперь не могу сообразить как связать все между собой, что в проге изменить надо, сам только начинаю баском осваивать.

$regfile = "m8def.dat"

$crystal = 8000000

Config Lcdpin = Pin , Db4 = Portc.3 , Db5 = Portc.2 , Db6 = Portc.1 , Db7 = Portc.0 , E = Portc.4 , Rs = Portc.5

Config Lcd = 16 * 2

Dim Conl As Byte

Dim Con As Byte

Dim Con_n As Integer

Dim I As Integer

Initlcd

Cursor Off

Cls

Locate 1 , 1

Lcd "**Wheel sensor**"

Wait 1

Cls

Portd.6 = 1

Portd.7 = 1

Portd.5 = 1

Portb.0 = 1

Portb.1 = 1

Portb.2 = 1

Config Portd.6 = Input : Config Portd.7 = Input : Config Portd.5 = Input

Config Portb.0 = Output : Config Portb.1 = Output : Config Portb.2 = Output

Config Timer0 = Timer , Prescale = 8

On Timer0 Tim0:

Enable Timer0

Enable Interrupts

Do

If Con_n <= 50 And Con_n >= -50 Then Portb.0 = 0 Else Portb.0 = 1 'определяем центр руля

If Con_n >= 200 Then Portb.1 = 0 Else Portb.1 = 1 'правое положение на включение'

If Con_n <= -200 Then Portb.2 = 0 Else Portb.2 = 1 'левое положение на включение'

If Pind.5 = 0 Then Con_n = 0 'установка нуля, центр руля'

If Pind.5 = 0 Then Lcd "Zero position"

If I <> Con_n Then Lcd Con_n 'вывод на экран для удобства настройки'

I = Con_n

Waitms 10

Cls

Loop

Tim0: 'обработка энкодера'

If Pind.6 = 0 And Pind.7 = 0 Then : Conl = 0 : End If

If Pind.6 = 1 And Pind.7 = 0 Then : Conl = 1 : End If

If Pind.6 = 1 And Pind.7 = 1 Then : Conl = 2 : End If

If Pind.6 = 0 And Pind.7 = 1 Then : Conl = 3 : End If

If Con = 0 And Conl = 1 Then : Incr Con_n : End If

If Con = 1 And Conl = 2 Then : Incr Con_n : End If

If Con = 2 And Conl = 3 Then : Incr Con_n : End If

If Con = 3 And Conl = 0 Then : Incr Con_n : End If

If Con = 0 And Conl = 3 Then : Decr Con_n : End If

If Con = 1 And Conl = 0 Then : Decr Con_n : End If

If Con = 2 And Conl = 1 Then : Decr Con_n : End If

If Con = 3 And Conl = 2 Then : Decr Con_n : End If

Con = Conl

Return

Помогите своими идеями. Энкодер промышленный autonics e40s8-1024.

[Реклама]

Реклама: ООО ТД Промэлектроника, ИНН: 6659197470, Тел: 8 (800) 1000-321