gesturer.pde

import processing.serial.*;
import cc.arduino.*;

final String fileName = "data.csv";
final String usbPort = "/dev/ttyUSB0";
final String TIME_CURVE_FILENAME = "curves/timeCurve.csv";

final boolean USE_OWN_CURVE = false;
final boolean ARDUINO_CONNECTED = false;

final int NUM_MOTORS = 3;

final int SFACTOR = 2;
//final float MOVE_GAIN_0 = 1.2;
//final float MOVE_GAIN_1 = 1.8;
final float MOVE_GAIN_0 = 1.5;
final float MOVE_GAIN_1 = 1.8;

boolean going[] = new boolean[NUM_MOTORS];
GesturePlayer[] gestPlayer = new GesturePlayer[NUM_MOTORS];
GestureRecorder gestRecorder, tempRecorder;

Arduino arduino;
Motor[] motor = new Motor[NUM_MOTORS];

float[] drawAngle = new float[NUM_MOTORS];
int pMX = -1;

void setup() {
    size(180*SFACTOR, 100*SFACTOR);
    background(102);

    println(Arduino.list());

    if(ARDUINO_CONNECTED)
	arduino = new Arduino(this, usbPort, 57600);

    //    motor[0] = new Motor(arduino, 12);
    //motor[1] = new Motor(arduino, 7);

    for(int i = 0; i < motor.length; i++){
	if(ARDUINO_CONNECTED)
	    motor[i] = new Motor(arduino, 10-NUM_MOTORS+i);
	drawAngle[i] = 80/MOVE_GAIN_0;
    }

    gestRecorder = new GestureRecorder(fileName);

    if(USE_OWN_CURVE){
	File f = new File(fileName);
	if (f.exists()){
	    println("\nNOTE: THERE APPEARS TO BE AN EXISTING DATA FILE. WILL USE IT. \n");//
	}
	else{
	    println("\nWARNING: DATA FILE DID NOT EXIST. CREATING ONE. \n");//
	    gestRecorder.clear();
	    gestRecorder.addPosition(0);
	}
    }

    for(int i = 0; i < gestPlayer.length; i++){
	if(USE_OWN_CURVE)
	    gestPlayer[i] = new GesturePlayer(fileName);
	else{
	    if(fileExists(TIME_CURVE_FILENAME))
		gestPlayer[i] = new GesturePlayer(TIME_CURVE_FILENAME);
	    else{
		tempRecorder = new GestureRecorder(TIME_CURVE_FILENAME);
		tempRecorder.clear();
		tempRecorder.addPosition(0);
		gestPlayer[i] = new GesturePlayer(TIME_CURVE_FILENAME);
	    }
	}
	going[i] = false;
    }

    //init to start position
    drawAngle[0] = gestPlayer[0].getPosition();
    for(int i = 0; i < gestPlayer.length; i++)
	gestPlayer[i].resetTime();
}

void draw() {
    thread("readPipe");
    background(100);
    
    if (mousePressed == false) {
	for(int i = 0; i < gestPlayer.length; i++){
	    if(going[i]){
		going[i] = !(gestPlayer[i].update(millis()));
		drawAngle[i] = gestPlayer[i].getPosition();
	    }
	}
	pMX = -1;
    }
    else{
	if(pMX != mouseX){
	    for(int i = 0; i < gestPlayer.length; i++)
		drawAngle[i] = constrain(mouseX/SFACTOR,0,180);
	    //		drawAngle[i] = mouseX*.01;
	    gestRecorder.addPosition(drawAngle[0]);
	}
	pMX = mouseX;
    }
    for(int i = 0; i < 180; i+=5){
	stroke(0);
	if(i%(15) == 0)
	    strokeWeight(1);
	else
	    strokeWeight(.1);
	line(i*SFACTOR,0,i*SFACTOR,height);
    }
    stroke(255,0,0);
    strokeWeight(2);
    line(mouseX,0,mouseX,height);

    translate(width/2, height/2);
    //    rotate(drawAngle[0] + PI);
    rotate(radians(drawAngle[0] + 180));
    noStroke();
    ellipse(0,0,15,15);
    rect(0, -2, 35, 4);

    // if(ARDUINO_CONNECTED)
    // 	for(int i = 0; i < motor.length; i++)
    // 	    motor[i].move(arduino,int(drawAngle[i])); //CHECK RANGE MAY NOT BE FULL    
    //THIS IS SET FOR PARTICULAR GEOMETRY OF THE TWO LEG SET TOWER
    if(ARDUINO_CONNECTED){
	motor[0].move(arduino,int(MOVE_GAIN_0 * drawAngle[0])); //CHECK RANGE MAY NOT BE FULL    
	motor[1].move(arduino,180 - int(MOVE_GAIN_1 * drawAngle[1])); //CHECK RANGE MAY NOT BE FULL    
    }

    
    //	motor[i].move(arduino,int(drawAngle[i]*57)); //CHECK RANGE MAY NOT BE FULL
}
 
void keyReleased(){
    if(key == '1')
	going[0] = true;
    if(key == '2')
	going[1] = true;
    if(key == '3')
	going[2] = true;
    if(key == 'w')
	exit();
}

void mousePressed(){
    gestRecorder.clear();
}

void mouseReleased(){
    for(int i = 0; i < gestPlayer.length; i++){
	going[i] = false;
	gestPlayer[i].init(fileName);
    }
}


void readPipe() {
    String[] s = loadStrings("sharingPlace.tmp");
    int level = int(s[0]);
    if(level == 1){
	going[0] = true;
    }
    else if (level == 2){
	going[0] = true;
	going[1] = true;
    }
}

boolean fileExists(String path) {
  File file=new File(path);
  boolean exists = file.exists();
  if (exists) {
    return true;
  }
  else {
    return false;
  }
}