//
//  ofxHelios.cpp
// 
//
//  Created by Tim Redfern Nov 2017
// 
//

#include "ofxHelios.h"

/*
draw a colourpolyline

put in mid points

draw a vector of lines

put in dwell points

*/

int ofxHelios::draw(vector <ofPolyline> &lines,ofColor colour,int intensity){
    return 0;
}

int ofxHelios::draw(ofPolyline &line,ofColor colour,int intensity){

    colourPolyline col=colourPolyline(line,colour);
    return draw(col,intensity);

}

int ofxHelios::draw(colourPolyline &line, int intensity){
    vector <colourPolyline> lines;
    lines.push_back(line);
    return draw(lines,intensity);
}

int ofxHelios::draw(vector <colourPolyline> &lines, int intensity){
        //todo: move to a thread
    //todo: add a transform
    //POC

    int xoffs=0x800-(ofGetWidth()/2);
    int yoffs=0x800-(ofGetHeight()/2);

    if (device!=OFXHELIOS_NODEVICE){
        while (!dac.GetStatus(device)); //timeout for this?
            //assemble data

        vector <HeliosPoint> points;

        ofPoint prev_point=lines[0][0];

        for (auto& line:lines){
            float joindist=prev_point.distance(line[0]);
            if (joindist>SUBDIVIDE){
                //printf("ofxHelios: creating %i join points\n",(int)joindist/SUBDIVIDE);  
            }
            for (float j=0;j<joindist;j+=SUBDIVIDE){
                float amt=j/joindist;
                points.push_back(HeliosPoint(
                    (uint16_t)((prev_point.x*(1.0-amt))+(line[0].x*amt)+xoffs),
                    (uint16_t)((prev_point.y*(1.0-amt))+(line[0].y*amt)+xoffs),
                    0,0,0,0)); //blank point
            }
            int i;
            for (i=0;i<line.size();i++){
                points.push_back(HeliosPoint(
                    (uint16_t)(line[i].x+xoffs),
                    (uint16_t)(line[i].y+yoffs),
                    (uint8_t)(((line.getColourAt(i).r)*laserintensity)>>8),
                    (uint8_t)(((line.getColourAt(i).g)*laserintensity)>>8),
                    (uint8_t)(((line.getColourAt(i).b)*laserintensity)>>8),
                    (uint8_t)intensity
                ));
            }
            for (int k=0;k<BLANK_NUM;k++){
                points.push_back(HeliosPoint(
                    (uint16_t)(line[line.size()-1].x+xoffs),
                    (uint16_t)(line[line.size()-1].y+yoffs),
                    0,0,0,0)); //blank point
            }
            
        }

        if (HELIOS_ERROR==dac.WriteFrame(device, pps, HELIOS_FLAGS_DEFAULT, &points[0], points.size())){
            printf("ofxHelios: write error (%i,%i,%i,%i)\n",device, pps, HELIOS_FLAGS_DEFAULT, (int)points.size());
            return -1;
        }

        return points.size();
    
            
    }
    return -2;
}


    

void ofxHelios::threadedFunction(){

    while(isThreadRunning()) {
         
    }
}