roboforum.ru

Код: Выделить всё • Развернуть

$regfile = "m16def.dat"                                     ' файл спецификации Меги8
$crystal = 16000000                                         ' указываем на какой частоте будем работать


'----------------------------------------------------------------------------
Config Timer1 = Pwm , Pwm = 8 , Prescale = 1 , Compare A Pwm = Clear Down , Compare B Pwm = Clear Down
Config Pind.3 = Output : Dr1 Alias Portd.3                  'ногу сконфигурировали как выход и обозвали Dr1
 Config Pind.6 = Output : Dr2 Alias Portd.6                 'ногу сконфигурировали как выход и обозвали Dr2
 Config Pind.5 = Output                    'ногу ШИМа 1-ого  движка сконфигурировали как выход
 Config Pind.4 = Output                    'ногу ШИМа 2-ого движка сконфигурировали как выход
'----------------------------------------------------------------------------

Dim Speed As Byte
Speed = 255                                                 ' указываем скорость робота

Config Rc5 = Pinc.6
Enable Interrupts
Dim Address As Byte , Command As Byte
Print "Start"                                               ' выводим в терминал отладочное сообщение

Do
   Gosub Прием_rc5
   If Command = 255 Then
      Gosub Стоп
       Waitms 0
  Elseif Command = 32 Then
      Gosub Прямо
       Waitms 0
   Elseif Command = 33 Then
      Gosub Назад
       Waitms 0
   Elseif Command = 17 Then
      Gosub Влево
       Waitms 0
   Elseif Command = 16 Then
      Gosub Вправо
       Waitms 0
   End If
Loop

Прием_rc5:
   Getrc5(address , Command)
   If Address <> 255 And Command <> 255 Then
      Command = Command And &B01111111
      'Print Chr(12);       ' выводим в терминал символ
      'Print "Address - " ; Address;       ' выводим в терминал адрес
      'Print "Command - " ; Command;       ' выводим в терминал номер команды
   End If
Return

Стоп:                                                       ' стоим на месте
 Dr1 = 0 : Dr2 = 0 : Pwm1a = 0 : Pwm1b = 0
 Return

 Прямо:
                     ' едим вперёд на заданной скорости
 Dr1 = 0 : Dr2 = 0 : Pwm1a = Speed : Pwm1b = Speed
 Return

 Назад:                    ' едим назад на заданной скорости

 Dr1 = 1 : Dr2 = 1 : Pwm1a = Speed : Pwm1b = Speed
 Return

 Вправо:                                                    ' делаем Разворот_вправо на заданной скорости

 Dr1 = 0 : Dr2 = 1 : Pwm1a = Speed : Pwm1b = Speed
 Return

 Влево:                                                     ' делаем Разворот_влево на заданной скорости

 Dr1 = 1 : Dr2 = 0 : Pwm1a = Speed : Pwm1b = Speed
 Return

cudi писал(а):Мне Dead сказал что у некоторых таких устро-в есть время заряда кондеров, для этого делают программ. задержку, а потом запускают устро-во

Код: Выделить всё • Развернуть

PORTD |= _BV(PD3); // установить "1" на линии 1 порта C
PORTD &=~ (1<<6); // установить "0" на линии 2 порта C
OCR1A = speed; // скорость ШИМ
OCR1B = speed; // скорость ШИМ

Код: Выделить всё • Развернуть

Разворот_влево:                    ' делаем Разворот_влево на заданной скорости 

 Dr1 = 1 : Dr2 = 0 : Pwm1a = Speed : Pwm1b = Speed 
 Return

cudi писал(а):А можешь ткнуть носом на этот участок. где нужно выбирать шим в 100% ? а то я не понял что то...