[syntax=basic4gl]Temp = Enkoder_odczyt
Zn = Inkey()
If Zn = Chr(8) Then
Adr_s = ""
Il_zn = 0 '
Do
Zn = Inkey()
If Zn >= "0" And Zn <= "9" Then
Incr Il_zn
Adr_s = Adr_s + Zn
Else
If Zn > Chr(0) Then
Exit Do
End If
End If
Loop
If Zn = "r" Then
If Il_zn > 0 And Il_zn < 3 Then
Adres = Val(adr_s)
If Adres = Adrr Then
Do
Zn = Inkey()
Loop Until Zn = Chr(13)
Set Re_de
Waitus 200
Print Temp
Waitms 1
Reset Re_de
End If
End If
End If
End If[/syntax]
cały program:
[syntax=basic4gl]'Konfiguracja
'****************************
'$sim
$regfile = "m32def.dat"
$crystal = 16000000
$hwstack = 40
$swstack = 16
$framesize = 32
$baud = 9600
'xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx
'porty
'xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx
Config Porta = Output
Config Portc.7 = Output
Config Portc.6 = Output
Config Portc.5 = Output
Config Portd.2 = Input
Config Portd.3 = Input
Config Portd.4 = Output
Config Portd.6 = Output
Config Portd.7 = Output
Config Print0 = Portb.2 , Mode = Set
Config Portb.2 = Output
Porta = 255
Portc.7 = 0
Portc.6 = 0
Portc.5 = 0
Portd.2 = 1
Portd.3 = 1
Portd.4 = 1
Portd.6 = 1
Portd.7 = 1
Config Serialin = Buffered , Size = 15
'Config Serialout = Buffered , Size = 15
Echo Off
Const Adrr = 5
'xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx
'aliasy
'xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx
W1 Alias Portc.7
W2 Alias Portc.6
W3 Alias Portc.5
Segmenty Alias Porta
Re_de Alias Portb.2
'xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx
'zmienne
'xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx
Dim I As Byte , Wyswietlacz As Byte , Tablica(3) As Byte
Dim E As Integer , F As Integer , Enkoder_odczyt As Integer
Dim Zadana As Integer , A As Integer , Temp As Integer
Dim C3 As Byte , C4 As Byte , C5 As Byte , Pwm_ As Byte
Dim Zn As String * 1 , Adr_s As String * 5 , Adres As Byte
Dim Il_zn As Byte , Test As Word
Dim Master_rx As Integer , Master_tx As Integer
'xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx
'timery
'xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx
Config Timer1 = Pwm , Pwm = 8 , Prescale = 256 , Compare B Pwm = Clear Down
Enable Timer1
Start Timer1
Config Timer0 = Timer , Prescale = 64
On Ovf0 Przerwanie
Load Timer0 , 1388
Enable Ovf0
Enable Interrupts
Enable Timer0
Load Timer0 = 250
'Enable Timer1
'Load Timer1 = 125
'-------------------------------
Config Int0 = Falling
On Int0 Enkoder
Enable Interrupts
Enable Int0
Tablica(1) = 0
Tablica(2) = 0
Tablica(3) = 0
Zadana = 180
Pwm_ = 200
Reset Re_de
Wait 1
Do
Enkoder_odczyt = E / 2
If Enkoder_odczyt => 360 Then
Enkoder_odczyt = 360
End If
If Enkoder_odczyt <= 0 Then
Enkoder_odczyt = 0
End If
A = Enkoder_odczyt
Temp = A \ 100
C3 = Temp
Temp = A Mod 100
Temp = Temp \ 10
C4 = Temp
Temp = A Mod 10
C5 = Temp
Tablica(1) = C3
Tablica(2) = C4
Tablica(3) = C5
If Enkoder_odczyt < Zadana Then
Gosub Cw
End If
If Enkoder_odczyt > Zadana Then
Gosub Ccw
End If
If Enkoder_odczyt = Zadana Then
Gosub Brake
End If
'Zn = Inkey()
'If Zn = Chr(114) Then
' Waitus 200
' Set Re_de
' Print Enkoder_odczyt
' Waitms 1
' Reset Re_de
' End If
'Print Enkoder_odczyt
'Set Re_de
'Waitus 50
Temp = Enkoder_odczyt
Zn = Inkey()
If Zn = Chr(8) Then
Adr_s = ""
Il_zn = 0 '
Do
Zn = Inkey()
If Zn >= "0" And Zn <= "9" Then
Incr Il_zn
Adr_s = Adr_s + Zn
Else
If Zn > Chr(0) Then
Exit Do
End If
End If
Loop
If Zn = "r" Then
If Il_zn > 0 And Il_zn < 3 Then
Adres = Val(adr_s)
If Adres = Adrr Then
Do
Zn = Inkey()
Loop Until Zn = Chr(13)
Set Re_de
Waitus 200
Print Temp
Waitms 1
Reset Re_de
End If
End If
End If
End If
Loop
End
Przerwanie:
Load Timer0 , 1388
Incr Wyswietlacz
If Wyswietlacz = 4 Then
Wyswietlacz = 1
End If
Select Case Wyswietlacz
Case 1:
W3 = 1
Segmenty = Lookup(tablica(1) , Kody7seg)
W1 = 0
Case 2:
W1 = 1
Segmenty = Lookup(tablica(2) , Kody7seg)
W2 = 0
Case 3:
W2 = 1
Segmenty = Lookup(tablica(3) , Kody7seg)
W3 = 0
End Select
Return
Cw:
Start Timer1
Pwm1b = Pwm_
Portd.6 = 0
Portd.7 = 1
Return
Ccw:
Start Timer1
Pwm1b = Pwm_
Portd.6 = 1
Portd.7 = 0
Return
Brake:
Stop Timer1
Pwm1b = 0
Portd.6 = 1
Portd.7 = 1
Return
Enkoder:
Disable Int0
'Waitms 1
If Pind.2 = 0 Then
If Pind.3 = 0 Then
Decr E 'Incr E
Incr F 'Decr F
Else
Incr E 'Decr E
Decr F 'Incr F
End If
End If
Enable Int0
Return
Kody7seg:
Data &B00000011 '0
Data &B10011111 '1
Data &B00100101 '2
Data &B00001101 '3
Data &B10011001 '4
Data &B01001001 '5
Data &B01000001 '6
Data &B00011111 '7
Data &B00000001 '8
Data &B00001001 '9
Data &B11111110 'dp
Data &B11100101 'c
Data &B11000101 'o
Data &B11010101 'n
Data &B00110001 'P[/syntax]
pozdrawiam Jacek.Statystyki: Napisane przez Jacek — 21 maja 2015, o 23:19
]]>
Bartek - kurczaczki