'754410 Demo

   dim speed

   const mot2a 5
   const mot2b 4
   const mot1a 8
   const mot1b 7
   
   speed = 200


   output mot2a
   output mot2b
   output mot1a
   output mot1b

   gosub mot1stop
   gosub mot2stop

loop:
   gosub botfwd
   longpause 255,4
   gosub botrev
   longpause 255,4   
   goto loop

botfwd:
   gosub mot1fwd
   gosub mot2fwd
   return

botrev:
   gosub mot1rev
   gosub mot2rev
   return

botright:
   gosub mot1fwd
   gosub mot1rev
   return

botleft:
   gosub mot1rev
   gosub mot2fwd
   return

botstop:
   gosub mot1stop
   gosub mot2stop
   return

mot1stop:
   low mot1a
   low mot1b
   return

mot1fwd:
   low mot1a
   high mot1b
   return

mot1rev:
   high mot1a
   low mot1b
   return

mot2stop:
   low mot2a
   low mot2b
   return

mot2fwd:
   low mot2a
   high mot2b
   return

mot2rev:
   high mot2a
   low mot2b
   return

setspeed:
     hwpwm 1,255,speed '1Khz 
     output 6
     return