۲۸-خرداد-۱۳۹۲, ۱۶:۳۱:۲۸
نه داداشی اختیار داری .
کابل های تلفن محله ی مارو دزدیده بودن ، این بود که نتونستم بیام.
اینم خدمت شما :
البته این برنامه ماله تست ربات PSK ( اینم ماله خودمون بود!) که توش یه کامپس هم راه اندازی شده ، البته من دیگه ویرایشش نکردم ،اگه دیدی پیچیدس ، بم بگو تا سورس SRF2 رو به صورت جدا واست بزارم!
کابل های تلفن محله ی مارو دزدیده بودن ، این بود که نتونستم بیام.
اینم خدمت شما :
البته این برنامه ماله تست ربات PSK ( اینم ماله خودمون بود!) که توش یه کامپس هم راه اندازی شده ، البته من دیگه ویرایشش نکردم ،اگه دیدی پیچیدس ، بم بگو تا سورس SRF2 رو به صورت جدا واست بزارم!
کد:
$regfile = "m64def.dat"
$crystal = 8000000
$baud = 9600
Config Lcd = 16 * 2
Config Lcdpin = Pin , Db4 = Portd.3 , Db5 = Portd.2 , Db6 = Portd.1 , Db7 = Portd.0 , E = Portd.4 , Rs = Portd.5
Config Timer1 = Pwm , Pwm = 10 , Compare A Pwm = Clear Up , Compare B Pwm = Clear Down , Prescale = 1
Config Timer2 = Timer , Prescale = 1
Enable Interrupts
Enable Timer2
On Timer2 Label
Label:
Return
Cls
Lcd "PSK Robot"
Waitms 500
Cls
Open "comd.6:9600,8,n,1" For Output As #5
Open "comd.7:9600,8,n,1" For Input As #6
Config Sda = Portb.3
Config Scl = Portb.2
Config I2cdelay = 1
Const C1 = 192
Const C2 = 193
Dim A As Byte
Dim B As Byte
Dim C As Word
Dim D As Byte
Dim E As Byte
Dim F As Word
Dim Msb As Byte
Dim Lsb As Byte
I2cstart
I2cwbyte 0
I2cwbyte 0
I2cwbyte 81
I2cstop
Waitms 65
I2cstart
I2cwbyte 224
I2cwbyte 2
I2cstart
I2cwbyte 225
I2crbyte Msb , Ack
I2crbyte Lsb , Nack
I2cstop
Do
I2cstart
I2cwbyte C1
I2cwbyte 2
I2cstart
I2cwbyte C2
I2crbyte A , Ack
I2crbyte B , Nack
I2cstop
C = A * 256
C = C + B
Printbin #5 , 0
Waitms 50
Printbin #5 , 84
D = Waitkey(#6)
E = Waitkey(#6)
F = D * 256
F = F + E
Home
Lcd "Dis: " ; F ; " "
Locate 2 , 1
Lcd "Deg: " ; C ; " "
Loop
End 'end program