Let's Make Robots!

Source code for Srf05 and picaxe 28x1

is this the correct way to adapt the source code of fritsl's "how to make yfr" for a srf05 sensor? ... i suppose not -_- .. T_T .. can you help me fritsl? :p 

 

 

 

Symbol dangerlevel = 50 ' how far away should thing be, before we react?
symbol turn = 300 ' this sets how much should be turned
symbol servo_turn = 700 ' This sets for how long time we should wait for the servo to turn (depending on it´s speed) before we measure distance
symbol trig = 3 ‘ Define output pin for Trigger pulse
symbol echo = 6 ‘ Define input pin for Echo pulse
symbol range = w1 ‘ 16 bit word variable for range

main: ' the main loop
pulsout trig,2 ‘ produce 20uS trigger pulse (must be minimum of 10uS)
pulsin echo,1,range ‘ measures the range in 10uS steps
pause 100
let range = range * 10 / 58 ‘ multiply by 10 then divide by 58
readadc range, b1
if b1 < dangerlevel then
gosub nodanger ' if nothing ahead, drive forward
else
gosub whichway ' if obstacle ahead then decide which way is better
end if
goto main ' this ends the loop, the rest are only sub-routines


nodanger:' this should be your combination to make the robot drive forward, these you most likely need to adjust to fit the way you have wired your robots motors
high 5 : high 6 : low 4 : low 7
goto main

whichway:
gosub totalhalt ' first stop!

'Look one way:
gosub lturn ' look to one side
pause servo_turn ' wait for the servo to be finished turning
gosub totalhalt
readadc range, b1
'Look the other way:
gosub rturn ' look to another side
pause servo_turn ' wait for the servo to be finished turning
gosub totalhalt
readadc range, b2

' Decide which is the better way:
if b1<b2 then
gosub body_lturn
else
gosub body_rturn
end if
return

body_lturn:
high 6 : low 5 : low 7 : high 4 ' this should be your combination that turns the robot one way
pause turn : gosub totalhalt
return

body_rturn:
high 5 : low 6 : low 4 : high 7 ' this should be your combination that turns the robot the other way
pause turn : gosub totalhalt
return

rturn:
servo 0, 100 ' look to one side
return

lturn:
servo 0, 200 ' look to the other side
return

totalhalt:
low 4 : low 5 : low 6 : low 7 ' low on all 4 halts the robot!
Servo 0,150 ' face forward
wait 1 ' freeze all for one second
return

Comment viewing options

Select your preferred way to display the comments and click "Save settings" to activate your changes.
where can I find that info? I would love to learn it!

I'm not sure if this is the best manual, because I don't own a picaxe. But after a quick google on 'picaxe manual' I found this for you. Try reading it, and try every example in it. You will have fun with it, and you'll learn to write your own programs, so you can let your robot do whatever you want!

GobliZ - Check out my robots

I'm trying to program a fluid moviment for my robot like the fritls's one in the part II.. the jklug80's code is a very good one but I want to avoid a "total stop" when the sensor sees an ostacle. fristl's can't you post your code? :p .. by the way, I'm going to traslate your tutorial "how to make your first robot part I" in a quite known italian blog, obviously with links and credits for this site. can I?
ok
my fricking servo is spining like tomorrow what number should I change?
I did read the manual but its just mumble jumble to me. I just want to get this thing working or I will throw it in the trash soon. What you talking about respect man? I am just trying to get my robot to work thats it. If you don't want to help thats find but don't talk like I am stupid. I got bettter stuff to do than spending all my spare time with this eventhough I find this interesting and just want to explore it.
I think what he was referring to is asking questions about basic programming topics. If you don't know what comments are or what they do, you won't get very far at all. You won't even be able to modify someone else's code. You really need to learn what the code does before EVER building a robot. Even if someone hands you all their code you have to know what it does or you won't get it to work. Study the code line by line and look up what it is doing so you understand it.

Yes. And stop making more postings in here before you have done so!

It's cool to be newbee and all, but comon, RTFM. I have send you links to it! 

- Or find someone to talk to about it, thay may also help! 

I been trying to program the robot for a few days now. Posting is for asking question and whatever I could not figure it out myself I will ask. If we don't ask question then what is the point of having this blog?