$regfile = "m8def.dat" $crystal = 8000000 $baud = 9600 $swstack = 128 $hwstack = 128 $framesize = 512 Config Lcd = 16 * 2 Config Lcdpin = Pin , Db4 = Portb.4 , Db5 = Portb.3 , Db6 = Portb.2 , Db7 = Portb.1 , E = Portc.4 , Rs = Portc.5 Cursor Off : Cls Config Portd.3 = Output En Alias Portd.3 Config Portd.2 = Input Rp Alias Pind.2 Config Portd.6 = Input : Portd.6 = 1 Config Portd.7 = Input : Portd.7 = 1 Up Alias Pind.6 Down Alias Pind.7 Declare Sub Send_command(byval Cmd As String) Declare Function Distance() As Byte Declare Sub Disp() Const Start_packet = "$" : Const End_packet = "#" Config Int0 = Falling Config Timer1 = Timer , Prescale = 8 : Stop Timer1 Config Timer0 = Timer , Prescale = 1024 : Stop Timer0 Enable Ovf1 Enable Int0 Enable Ovf0 Enable Interrupts On Int0 Recive On Ovf1 Overflow On Ovf0 On_sleep Dim T_val As Word , Sf As Bit Dim Udist As Byte Dim Send As Bit Dim K1 As Bit , K2 As Bit Dim Al_dist As Byte Dim F As Eram Byte Dim Ad As Eram Byte If F = 255 Then : F = 0 : Ad = 0 : End If En = 0 Sf = 0 Waitms 100 Home : Lcd "Test Beep" Send_command "beep5" Waitms 400 Cls Al_dist = Ad Start Timer0 Do En = 1 Start Timer1 Waitms 10 If Up = 0 And K1 = 0 Then K1 = 1 Al_dist = Ad Incr Al_dist Ad = Al_dist Disp End If : If Up = 1 And K1 = 1 Then K1 = 0 If Down = 0 And K2 = 0 Then K2 = 1 Al_dist = Ad Decr Al_dist Ad = Al_dist Disp End If : If Down = 1 And K2 = 1 Then K2 = 0 If Sf = 0 Then Sf = 1 Udist = Distance() Disp If Udist < Ad Then Send_command "beep3" Timer1 = 0 End If Loop End Recive: Stop Timer1 T_val = Timer1 En = 0 Sf = 0 Return Sub Disp Cls Locate 1 , 1 : Lcd Udist : Locate 1 , 5 : Lcd "CM" Locate 2 , 1 : Lcd Al_dist : Locate 2 , 5 : Lcd "CM" End Sub Overflow: Stop Timer1 Timer1 = 0 En = 0 Return On_sleep: If Send = 0 Then Udr = Asc( "&") Return Function Distance() As Byte Local Dist As Single Dist = T_val * 50 Dist = Dist / 3504 Distance = Round(dist) End Function Sub Send_command(byval Cmd As String) Local I As Byte Send = 1 For I = 1 To 5 Print Start_packet ; Cmd ; End_packet Waitms 20 Next Send = 0 Waitms 20 End Sub
دیدگاه