node-bots script

sumobotjr.js

// =======================
// Sumobot Jr demo program
// =======================

var five = require("johnny-five");
var keypress = require('keypress');

keypress(process.stdin);

var board = new five.Board();

board.on("ready", function() {

  console.log("Welcome to Sumobot Jr!")
  console.log("Control the bot with the arrow keys, and SPACE to stop.")

  var left_wheel  = new five.Servo({ pin:  9, type: 'continuous' }).stop();
  var right_wheel = new five.Servo({ pin: 10, type: 'continuous'  }).stop();

  var perfect_angle = 100;
  var attack_angle = 0;
  var sweeper = new five.Servo({ pin: 6, type: 'standard' }).to(perfect_angle);


  process.stdin.resume(); 
  process.stdin.setEncoding('utf8'); 
  process.stdin.setRawMode(true); 

  process.stdin.on('keypress', function (ch, key) {
    
    if ( !key ) return;


    if ( key.name == 'q' ) {

      console.log('Quitting');
      process.exit();

    } else if ( key.name == 'up' ) {

      console.log('Forward');
      left_wheel.cw();
      right_wheel.ccw();

    } else if ( key.name == 'down' ) {

      console.log('Backward');
      left_wheel.ccw();
      right_wheel.cw();

    } else if ( key.name == 'left' ) {

      console.log('Left');
      left_wheel.ccw();
      right_wheel.ccw();      


    } else if ( key.name == 'right' ) {

      console.log('Right');
      left_wheel.cw();
      right_wheel.cw();

    } else if ( key.name == 'space' ) {

      console.log('Stopping');
      left_wheel.stop();
      right_wheel.stop();

    } else if ( key.name == 's' ) {
      sweeper.to(attack_angle);
    } else if ( key.name == 'd' ) {
      sweeper.to(perfect_angle);
    }


  });


});