Witam, mam taki problem sprawdziłem elektronikę w robocie, wgrałem program i włączyłem zasilanie. I po włączeniu zasilania prawy silnik zaczął się kręcić do przodu a lewy nic nie ruszał się. Co może być nie tak i jak to naprawić. I gzie na zaciskach silników jest plus a gdzie minus? Proszę o pomoc.

$regfile = "m88def.dat"
$crystal = 16000000
'Konfiguracja przetwornika analog-cyfra (ADC)
Config Adc = Single , Prescaler = Auto
'Konfiguracja sterowania sprzętowym PWM
Config Timer1 = Pwm , Pwm = 8 , Prescale = 1 , Compare A Pwm = Clear Down , Compare B Pwm = Clear Down
'Konfiguracja portów
Config Portb = Output
Config Portd = &B01111111
Config Portc = Input
Portd.7 = 1
Przycisk Alias Pind.7
Led Alias Portd.6
Enable_a Alias Portb.1
Enable_b Alias Portb.2
Silnik_prawy_a Alias Portd.3
Silnik_prawy_b Alias Portd.2
Silnik_lewy_a Alias Portd.1
Silnik_lewy_b Alias Portd.0
'Opis portów
'Enable_a - Silnik lewy - Portb.1 (PWM1A)
'Enable_b - Silnik prawy - portb.2 (PWM1B)
'Input1 - Silnik prawy A - Portd.3
'Input2 - Silnik prawy B - Portd.2
'Input4 - Silnik lewy A - Portd.0
'Input3 - Silnik lewy B - Portd.1
'Dioda - Portd.6
'Czujnik lewy końcowy - ADC5
'Czujnik lewy - ADC4
'Czujnik środkowy1 - ADC3
'Czujnik środkowy2 - ADC2
'Czujnik prawy - ADC1
'Czujnik prawy końcowy - ADC0
'Granica reagowania na linię - należy dobrać doświadczalnie
Const Granica = 500
'Deklaracje zmiennych
Dim Czujnik_lewy1 As Single
Dim Czujnik_lewy As Single
Dim Czujnik_srodkowy1 As Single
Dim Czujnik_srodkowy2 As Single
Dim Czujnik_prawy As Single
Dim Czujnik_prawy1 As Single
Dim W As Word
'Blok instrukcji
Set Silnik_lewy_a
Reset Silnik_lewy_b
Set Silnik_prawy_a
Reset Silnik_prawy_b
Do
Gosub Wczytaj_stany_przetwornikow
If Czujnik_srodkowy1 > Granica Then
'Silnik lewy - maksymalna prędkość
Pwm1a = 255
'Silnik prawy - maksymalna prędkość
Pwm1b = 255
Elseif Czujnik_srodkowy2 > Granica Then
Pwm1a = 255
Pwm1b = 255
Elseif Czujnik_lewy > Granica Then
Pwm1a = 0
Pwm1b = 255
Elseif Czujnik_lewy1 > Granica Then
Pwm1a = 0
Pwm1b = 255
Elseif Czujnik_prawy > Granica Then
Pwm1a = 255
Pwm1b = 0
Elseif Czujnik_prawy1 > Granica Then
Pwm1a = 255
Pwm1b = 0
Else
Pwm1a = 255
Pwm1b = 255
End If
Loop
End
Wczytaj_stany_przetwornikow:
Start Adc
W = Getadc(0)
W = Getadc(0)
Stop Adc
Czujnik_prawy = W
Start Adc
W = Getadc(1)
W = Getadc(1)
Stop Adc
Czujnik_lewy1 = W
Start Adc
W = Getadc(5)
W = Getadc(5)
Stop Adc
Czujnik_lewy = W
W = Getadc(4)
W = Getadc(4)
Stop Adc
Czujnik_srodkowy1 = W
W = Getadc(3)
W = Getadc(3)
Stop Adc
Czujnik_srodkowy2 = W
W = Getadc(2)
W = Getadc(2)
Stop Adc
Czujnik_prawy1 = W
Return