roboforum.ruТехнический форум по робототехнике. |
|
|
'************************************************************
$regfile = "ATtiny2313.DAT" ' файл спецификации тини2313
$crystal = 4000000 ' указываем на какой частоте будем работать
Config Pind.2 = Output : Dr1 Alias Portd.2
Config Pind.3 = Output : Dr2 Alias Portd.3
Config Pind.4 = Output : Dr3 Alias Portd.4
Config Pind.5 = Output : Dr4 Alias Portd.5
Config Pind.0 = Input : Vpravo Alias Portd.0 ' праый датчик цепляется на PD.0 Тини2313
Config Pind.1 = Input : Vlevo Alias Portd.1 ' левый датчик цепляется на PD.1 тини2313
'************************************************************
Vpravo = 1
Vlevo = 1
'********************Основной цикл***************************
Do
Gosub Прямо
If Pind.1 = 0 Then
Gosub Назад : Waitms 400 : Gosub Налево : Waitms 400
Elseif Pind.0 = 0 Then
Gosub Назад : Waitms 400 : Gosub Направо : Waitms 400
End If
Loop
'********************Комбинации моторов**********************
Налево: ' едем налево
Dr1 = 0 : Dr2 = 1 : Dr3 = 1 : Dr4 = 0 :
Return
Направо: ' едем направо
Dr1 = 1 : Dr2 = 0 : Dr3 = 0 : Dr4 = 1 :
Return
Прямо: ' едем прямо
Dr1 = 1 : Dr2 = 0 : Dr3 = 1 : Dr4 = 0 :
Return
Назад: ' едем назад
Dr1 = 0 : Dr2 = 1 : Dr3 = 0 : Dr4 = 1 :
Return
Стоп: ' стоим на месте
Dr1 = 0 : Dr2 = 0 : Dr3 = 0 : Dr4 = 0 :
Return
Вернуться в Новичкам или основы основ роботостроения.
Сейчас этот форум просматривают: нет зарегистрированных пользователей и гости: 0