diff options
| author | Ido Hadanny <ido.hadanny@gmail.com> | 2011-09-22 21:30:13 +0300 |
|---|---|---|
| committer | Ido Hadanny <ido.hadanny@gmail.com> | 2011-09-22 21:30:13 +0300 |
| commit | 53b947df484159f5934898ba6c0aa69a9c869007 (patch) | |
| tree | 189d5903a67765c390de8f1e3423e6b80cde57d1 /roombacomm-client/src/com/hackingroomba/roombacomm/Spiral.java | |
| parent | 654ca6d59e99b5e72b05dfb917bc5888c4ba6b1b (diff) | |
added stuff
Diffstat (limited to 'roombacomm-client/src/com/hackingroomba/roombacomm/Spiral.java')
| -rw-r--r-- | roombacomm-client/src/com/hackingroomba/roombacomm/Spiral.java | 127 |
1 files changed, 127 insertions, 0 deletions
diff --git a/roombacomm-client/src/com/hackingroomba/roombacomm/Spiral.java b/roombacomm-client/src/com/hackingroomba/roombacomm/Spiral.java new file mode 100644 index 0000000..9333d04 --- /dev/null +++ b/roombacomm-client/src/com/hackingroomba/roombacomm/Spiral.java @@ -0,0 +1,127 @@ +/* + * roombacomm.Spiral -- test out the DRIVE command, showing a spiral + * + * Copyright (c) 2006 Tod E. Kurt, tod@todbot.com, ThingM + * + * This library is free software; you can redistribute it and/or + * modify it under the terms of the GNU Lesser General Public + * License as published by the Free Software Foundation; either + * version 2.1 of the License, or (at your option) any later version. + * + * This library is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * Lesser General Public License for more details. + * + * You should have received a copy of the GNU Lesser General + * Public License along with this library; if not, write to the + * Free Software Foundation, Inc., 59 Temple Place, Suite 330, + * Boston, MA 02111-1307 USA + * + */ + + +package com.hackingroomba.roombacomm; + +import java.io.*; + +/** + Make the Roomab drive in a spiral. + <p> + Run it with something like: <pre> + java roombacomm.Spiral /dev/cu.KeySerial1<br> + Usage: + roombacomm.Spiral <serialportname> [protocol] [options]<br> + where: protocol (optional) is SCI or OI + [options] can be one or more of: + -debug -- turn on debug output + -hwhandshake -- use hardware-handshaking, for Windows Bluetooth + -nohwhandshake -- don't use hardware-handshaking + </pre> + + */ +public class Spiral { + + static String usage = + "Usage: \n"+ + " roombacomm.Spiral <serialportname> [protocol] [options]\n" + + "where: protocol (optional) is SCI or OI\n" + + "[options] can be one or more of:\n"+ + " -debug -- turn on debug output\n"+ + " -hwhandshake -- use hardware-handshaking, for Windows Bluetooth\n"+ + " -nohwhandshake -- don't use hardware-handshaking\n"+ + "\n"; + static boolean debug = false; + static boolean hwhandshake = false; + + public static void main(String[] args) { + if( args.length == 0 ) { + System.out.println( usage ); + System.exit(0); + } + String portname = args[0]; // e.g. "/dev/cu.KeySerial1" + RoombaCommSerial roombacomm = new RoombaCommSerial(); + for( int i=1; i<args.length; i++ ) { + if (args[i].equals("SCI") || (args[i].equals("OI"))) { + roombacomm.setProtocol(args[i]); + } else if( args[i].endsWith("debug") ) + debug = true; + else if( args[i].endsWith("nohwhandshake") ) + roombacomm.setWaitForDSR(false); + else if( args[i].endsWith("hwhandshake") ) + roombacomm.setWaitForDSR(true); + } + roombacomm.debug = debug; + + if( ! roombacomm.connect( portname ) ) { + System.out.println("Couldn't connect to "+portname); + System.exit(1); + } + + System.out.println("Roomba startup"); + roombacomm.startup(); + roombacomm.pause(100); + roombacomm.control(); + roombacomm.pause(100); + + int pausetime = 500; + int speed = 100; + int r = 10; + int dr = 20; + + System.out.println("Press return to exit."); + boolean done = false; + while( !done ) { + System.out.println("r:"+r); + + roombacomm.drive( speed, r ); + r += dr; + if( Math.abs(r) > 410 ) { + dr = -dr; + } + + done = keyIsPressed(); + + roombacomm.pause( pausetime ); + } + + roombacomm.stop(); + + System.out.println("Disconnecting"); + roombacomm.disconnect(); + + System.out.println("Done"); + } + + /** check for keypress, return true if so */ + public static boolean keyIsPressed() { + boolean press = false; + try { + if( System.in.available() != 0 ) { + System.out.println("key pressed"); + press = true; + } + } catch( IOException ioe ) { } + return press; + } +} |
