File content as of revision 5:e02cd57242c7:

/*
~~~~~~present status~~~~~~
    * X Y data from sereal.  vx and vy are culculated like -> (new X,Y) - (previous X,Y) / timer
        --  i don't know how to send data quickly
    
    now I'm fighting to other problems...
*/


#include "mbed.h"
#include "laserProjectorHardware.h"
#include <vector>

void processSerial();
Timer timer;
LocalFileSystem local("local");
//Serial pc(USBTX, USBRX);

unsigned int X, Y, T;   // these datas are from other tracking system... 
unsigned int beforeX , beforeY;
int startX = CENTER_AD_MIRROR_X;
int startY = CENTER_AD_MIRROR_Y;

float vx = 0, vy=0, omegaX=0, omegaY=0; 
float theta=0,scale=700;
unsigned int dt=500, timecounter = 0;

bool newPositionReady=false;
unsigned int counter=0;
vector<char> inputletters;

struct point2d {
    int x,y;
};
struct letter {
    int pointnum;
    vector<point2d> letpoints;
};

//int points[200][2] = {};
vector<letter> libletter;   // letter library

vector<int> buf;                            //buffer vector
vector<int> buf2;

/*void makeBuffer()
{
    float sint = sin(theta);
    float cost = cos(theta);

    startX = CENTER_AD_MIRROR_X;
    startY = CENTER_AD_MIRROR_Y;

    buf.clear();
/*conversion points to buf before writing;
    for(int i=0; i<inputletters.size(); i++) {
        
        buf.push_back(222);
        buf.push_back(222);
        
        for(int j=0; j<libletter[inputletters[i]-'a'].letpoints.size(); j++) {
            int x = 0.8*scale/1000*(libletter[inputletters[i]-'a'].letpoints[j].x +500*(i-inputletters.size()/2.0));
            int y = -scale/1000*(libletter[inputletters[i]-'a'].letpoints[j].y);
            buf.push_back(x);
            buf.push_back(y);
        }
    }

}
*/

int main()
{
    
    
    FILE *fp = fopen("/local/test.txt", "r");
    if(!fp) {
        IO.setGreenPower(1);
        exit(1);
    }
    int letternum;
    fscanf(fp, "%d", &letternum);
    for(int i=0; i<letternum; i++) {
        letter bufl;
        fscanf(fp, "%d", &bufl.pointnum);
        for(int j=0; j<bufl.pointnum; j++) {
            point2d bufp;
            fscanf(fp, "%d", &bufp.x);
            fscanf(fp, "%d", &bufp.y);
            bufl.letpoints.push_back(bufp);
        }
        libletter.push_back(bufl);
    }


    //makeBuffer();

    // SETUP: --------------------------------------------------------------------------------------------
    IO.init(); // note: serial speed can be changed by checking in the hardwareIO.cpp initialization

    // Set displaying laser powers:
    IO.setRedPower(0);
    IO.setGreenPower(0);//turn on the green (displaying) laser

    wait_ms(100);

    
    X = beforeX = CENTER_AD_MIRROR_X;
    Y = beforeY = CENTER_AD_MIRROR_Y;
    timer.start();
    // MAIN LOOP: --------------------------------------------------------------------------------------------
    while(1) {
        if (pc.readable()>0) processSerial();
        
        
        float sint = sin(theta);
        float cost = cos(theta);

        for(int i=0; i<inputletters.size(); i++) {
            if (pc.readable()>0) processSerial();
            wait(0.1);
            for(int j=0; j<libletter[inputletters[i]-'a'].letpoints.size(); j++) {
                int x = 0.8*scale/1000*(libletter[inputletters[i]-'a'].letpoints[j].x - vx*dt/1000*j); //+500*(i-inputletters.size()/2.0));
                int y = -scale/1000*(libletter[inputletters[i]-'a'].letpoints[j].y);
                IO.writeOutXY(X+cost*x + sint*y,Y-sint*x + cost*y);
                wait_us(dt);
                IO.setRGBPower(0);//on
            }
            IO.setRGBPower(1);
            wait(0.01);
        }

        /*for(int j=0; j<buf.size()/2; j++) {
            if ( (buf[j*2] == 222) && (buf[j*2+1] == 222)){
                IO.setRGBPower(1);
                int xx=buf[j*2+2]- vx*dt/1000*j;
                int yy=buf[j*2+3];//- vy*dt/1000*j;
                IO.writeOutXY(startX+cost*xx + sint*yy,startY-sint*xx + cost*yy);
                wait(0.0004);
                IO.setRGBPower(0);
            }
            else{
            timer.start();
            int xx=buf[j*2]- vx*dt/1000*j;
            int yy=buf[j*2+1];//- vy*dt/1000*j;
            IO.writeOutXY(startX+cost*xx + sint*yy,startY-sint*xx + cost*yy);
            wait_us(dt);
            IO.setRGBPower(0); //on
            timer.stop();
            //dt=timer.read();
            }
            
            timecounter += dt;
            if(timecounter >= T) timecounter = 0; 
        }*/
        buf2.clear();
        IO.setRGBPower(1); //off
        wait(0.02);

    }
}


// --------------------------------------------------------------------------------------------
// String to store ALPHANUMERIC DATA (i.e., integers, floating point numbers, unsigned ints, etc represented as DEC) sent wirelessly:
char stringData[24]; // note: an integer is two bytes long, represented with a maximum of 5 digits, but we may send floats or unsigned int...
int indexStringData=0;//position of the byte in the string

void processSerial()
{

    while(pc.readable()>0) {

        char val =pc.getc();

        // Save ASCII numeric characters (ASCII 0 - 9) on stringData:
        if ((val >= '0') && (val <= '9')) { // this is 45 to 57 (included)
            stringData[indexStringData] = val;
            indexStringData++;
        } else if ((val >= 'a') && (val <= 'z')) { // this is 45 to 57 (included)
            inputletters.push_back(val);
        }

        /*else if (val == '/') {
            makeBuffer();
        }*/ else if (val == '.') {
            inputletters.clear();
        }

        else if (val == 'X') {
            beforeX = X;
            stringData[indexStringData] = 0;
            X = atoi(stringData);
            indexStringData=0;
            timer.stop();
            vx = ((float)X-(float)beforeX) / timer.read();
            //newSpeedReady = true;
            theta=atan2(vx,vy);
            timer.start();
        }

        else if (val == 'Y') {
            beforeY = Y;
            stringData[indexStringData] = 0;
            Y = atoi(stringData);
            indexStringData=0;
            timer.stop();
            //newSpeedReady = true;
            vx = ((float)Y-(float)beforeY) / timer.read();
            theta=atan2(vx,vy);
            timer.start();
        }

        else if (val == 'T') {
            stringData[indexStringData] = 0;
            dt = atoi(stringData);
            indexStringData=0;
            //makeBuffer();
        } else if (val == 'S') {
            stringData[indexStringData] = 0;
            scale = atoi(stringData);
            indexStringData=0;
            //makeBuffer();
        } 
        // X value?
        /*else if (val=='x') {
            stringData[indexStringData] = 0 ;
            omegaX=atoi(stringData);
            indexStringData=0;
            //newPositionReady=true;
        }
        // Y value?
        else if (val=='y') {
            stringData[indexStringData] = 0 ;
            omegaY=atoi(stringData);
            indexStringData=0;
            makeBuffer();
            newPositionReady=true;
        }

        else if (val=='g') {
            stringData[indexStringData] = 0 ;
            int power=atoi(stringData);
            indexStringData=0;
            IO.setGreenPower(power);
        } else if (val=='r') {
            stringData[indexStringData] = 0 ;
            int power=atoi(stringData);
            indexStringData=0;
            IO.setRedPower(power);
        } else if (val=='c') {
            stringData[indexStringData] = 0 ;
            int power=atoi(stringData);
            indexStringData=0;
            IO.setRGBPower(power);
        }
        */

    }
}