کمک برای ساخت ربات مسیریاب ساده (فوری)

[milad15m]

سلام . من دارم یک ربات مسیریاب ساده 3 سنسوره می سازم که یه برنامه با کامپایلر بسکام نوشتم که اگه اشکال داره بفرمایید تصحیح کنم .
موتور 1 به PA.0 و PA.1 وصله و موتور 2 به PA.2 و PA.3 وصله.
LED های نشان دهنده روشن بودن سنسور ها به PA.5 و PA.6 و PA.7 وصله .
سنسور 1 به PB.0 , سنسور 2 به PB.1 , سنسور 3 به PB.2 وصله.
سنسور ها : (1)*
(0)* *(2)

کد:

"regfile "m16def.dat$
$crystal = 14000000
Config Porta = Output
Config Portb = Input
Do
If Pinb = &H00 Then
Porta = &H0A
Elseif Pinb = &H01 Then
Porta = &H14
Elseif Pinb = &H02 Then
Porta = &H25
Elseif Pinb = &H03 Then
Porta = &H31
Elseif Pinb = &H04 Then
Porta = &H44
Elseif Pinb = &H05 Then
Porta = &H5A
Elseif Pinb = &H06 Then
Porta = &H61
Elseif Pinb = &H07 Then
Porta = &H75
End If
Loop
End

[omid_phoenix]

سلام خوش اومدید
تعریف سنسورها بستگی به مسیرکشی هاتون داره
مسیر و حداقل زاویه رو بگید برنامه شو بذارم

راستی کریستال رو چرا 14مگ گذاشتید
8مگ داخلی کار کنید روباتتون پرواز میکنه

[milad15m]

سلام . robo از کمکت منونم .
حداقل زاویه مسیر 45 درجه هست.

[omid_phoenix]

سلام از شانس نرم افزار بسکام بالا نیومد برنامه شو بنویسم
شما شبیه ساز همین پروژه رو دارید بذارید بررسی کنم

فقط از نظر من شرط ها رو با case تعریف کنید بهتره
بعدم اینکه یه تقسیم بندی از جهات داشته باشید
فرضا
'============================= jolo =============================
دستورات حرکت به جلو

'=============================enheraf b chap=====================
دستورات حرکت به چپ

'=============================enheraf b rast=====================
دستورات حرکت به راست

این حالتی که شما مینوسید تعداد دستورات بالا بره برنامه درصد فهم پذیریش پایین تر میاد

[milad15m]

سلام
تمام کار هایی که گفتید انجام دادم ببینید برنامه درسته.
دستتون درد نکنه.
برنامه و شبیه سازی شوهم گذاشتم.

کد:

$regfile "m16def.dat"
$crystal = 8000000
Config Porta = Output
Config Portb = Input
Dim A As Byte
Do
'=======================================agab====================================
If Pinb = &H00 Then
A = 1
Elseif Pinb = &H05 Then
A = 1
'=====================================jolo=======================================
Elseif Pinb = &H02 Then
A = 2
Elseif Pinb = &H07 Then
A = 2
'================================chap gard=======================================
Elseif Pinb = &H03 Then
A = 3
Elseif Pinb = &H06 Then
A = 3
'================================rast gard=======================================
Elseif Pinb = &H01 Then
A = 4
Elseif Pinb = &H04 Then
A = 4
End If

Select Case A
'=======================================agab====================================
Case 1 : Porta = &H0A
'=======================================jolo=====================================
Case 2 : Porta = &H05
'==================================chap gard=====================================
Case 3 : Porta = &H01
'===================================rast gard===================================
Case 4 : Porta = &H04
End Select
Loop
End

test

[milad15m]

کسی نمی خواد جواب بده؟