Connect with us

Basic Stamp 2 Remote Control Bot

Discussion in 'Microcontrollers, Programming and IoT' started by Wheelie016, Feb 2, 2013.

Scroll to continue with content
  1. Wheelie016

    Wheelie016

    10
    0
    Nov 20, 2012
    I am using the Basic Stamp 2, Two Xbee's, and a Pololu Serial Servo Controller. My goal is is to have the bot controlled from my computer. The thing is, it works some of the time, just more often that it doesn't than it does..alot more often. This is my code:

    'Remote Control Bot v1

    Direction VAR Word

    Xbee CON 12
    ServoCtrl CON 0
    R_ServoP CON 1
    L_ServoP CON 5
    LCD_P CON 14

    Setup:
    SEROUT 14, 84, [22,12]
    PAUSE 5



    Main:

    SERIN 12, 84, [direction]
    SEROUT 14, 84, [direction]

    IF direction = "w" THEN
    SEROUT 1, 84, [$80,$01,$04,R_ServoP,20,50]
    SEROUT 1, 84, [$80,$01,$04,L_ServoP,24,50]
    SEROUT 14, 84, [12,"Moving Forward"]
    GOTO Main


    ELSEIF direction = "a" THEN
    SEROUT 1, 84, [$80,$01,$04,R_ServoP,21,50]
    SEROUT 1, 84, [$80,$01,$04,L_ServoP,22,50]
    SEROUT 14, 84, [12,"Turning Left"]
    GOTO Main

    ELSEIF direction = "s" THEN
    SEROUT 1, 84, [$80,$01,$04,R_ServoP,24,50]
    SEROUT 1, 84, [$80,$01,$04,L_ServoP,20,50]
    SEROUT 14, 84,[12,"Moving Backwards"]
    GOTO Main
    ELSEIF direction = "d" THEN
    SEROUT 1, 84, [$80,$01,$04,R_ServoP,22,50]
    SEROUT 1, 84, [$80,$01,$04,L_ServoP,23,50]
    SEROUT 14, 84,[12,"Turning Right"]
    GOTO Main

    ELSE
    SEROUT 14, 84, [12,"[Invalid Character]"]
    PAUSE 5
    ENDIF

    GOTO Main



    I've tried replacing the SERIN command with DEBUGIN to make sure it wasn't something to do with the Xbee. The LCD connected to Pin 14 responds, as in it shows "Moving Forward" when "w" is sent to the Stamp, but the Servo Controller does not. I can't for the life of me figure out why?? On the rare occasions that it does work, there is a green LED on the Controller that shows incoming serial data, but 9 times out of 10, the Yellow Standby LED just stays on as if the Stamp isn't sending it anything.

    Any advice on how to figure out what might be the cause of it's unreliable performance, whether it be software or hardware related, would be much appreciated.
     
Ask a Question
Want to reply to this thread or ask your own question?
You'll need to choose a username for the site, which only take a couple of moments (here). After that, you can post your question and our members will help you out.
Electronics Point Logo
Continue to site
Quote of the day

-