Subversion Repositories seema-scanner

#include "ProjectorLC3000.h"

// Additions to the LC3000 API
#include "LC3000API/lcr_packetizer.h"
ErrorCode_t LCR_CMD_DisplayPattern(LCR_PatternCount_t PtnNumber){
    /* Generate packet */
    LCR_CMD_PKT_CommandInit(LCR_CMD_PKT_TYPE_WRITE, 0x0405);
    LCR_CMD_PKT_PutInt(PtnNumber, 2);
    if(LCR_CMD_PKT_SendCommand())
        return FAIL;

    return SUCCESS;
}

#include "LC3000API/bitmap_image.hpp"

#define HandleResult(res,place) if (res!=SUCCESS) {printf("ProjectorLC3000: Error at %s (%d)\n",place,res); fflush(stdout);}

ProjectorLC3000::ProjectorLC3000(unsigned int){

    // Make connection
    res = LCR_CMD_Open();
    HandleResult(res,"LCR_CMD_Open()")

    // Set power on (if in standby)
    res = LCR_CMD_SetPowerMode(PWR_NORMAL);
    HandleResult(res,"LCR_CMD_SetPowerMode()")

    // Set LED currents to max brightness
    LCR_LEDCurrent_t ledCurrents = {255,255,255};
    res = LCR_CMD_SetLEDCurrent(&ledCurrents);
    HandleResult(res,"LCR_CMD_SetLEDCurrent()")

    // Set display settings to no rotate, no long axis flix, short axis flip
    LCR_DisplaySetting_t displaySettings = {0,0,1};
    res = LCR_CMD_SetDisplaySetting(&displaySettings);
    HandleResult(res,"LCR_CMD_SetDisplaySetting()")

    // Set trigger output settings
    LCR_CamTriggerSetting_t triggerSettings;
    triggerSettings.Enable = 1;
    triggerSettings.Source = 0;
    triggerSettings.Polarity = TRIGGER_EDGE_POS;
    triggerSettings.Delay = 0;
    triggerSettings.PulseWidth = 200; //us
    res = LCR_CMD_SetCamTriggerSetting(&triggerSettings);
    HandleResult(res,"LCR_CMD_SetCamTriggerSetting()")

    // Set default pattern sequence settings
    patternSeqSettings.BitDepth = 8;
    patternSeqSettings.NumPatterns = 1;
    patternSeqSettings.PatternType = PTN_TYPE_NORMAL;
    patternSeqSettings.InputTriggerType = TRIGGER_TYPE_SW;
    patternSeqSettings.InputTriggerDelay = 0;
    patternSeqSettings.AutoTriggerPeriod = 0;
    patternSeqSettings.ExposureTime = 16666; //us
    patternSeqSettings.LEDSelect = LED_RED;
    patternSeqSettings.Repeat = 1;
    res = LCR_CMD_SetPatternSeqSetting(&patternSeqSettings);
    HandleResult(res,"LCR_CMD_SetPatternSeqSetting()")

}

void ProjectorLC3000::setPattern(unsigned int patternNumber, const unsigned char *tex, unsigned int texWidth, unsigned int texHeight){

    // Set pattern count
    unsigned int nPatterns = std::max((unsigned int)patternSeqSettings.NumPatterns, patternNumber+1);
    patternSeqSettings.NumPatterns = nPatterns;
    res = LCR_CMD_SetPatternSeqSetting(&patternSeqSettings);
    HandleResult(res,"LCR_CMD_SetPatternSeqSetting()")

    // Tile texture
    char texTiled[608][684][3];
    for(unsigned int j=0; j<608; j++){
        int jIdx = j%texWidth;
        for(unsigned int i=0; i<684; i++){
            int iIdx = i%texHeight;
            texTiled[j][i][0] = tex[iIdx*texWidth*3 + jIdx*3 + 0];
            texTiled[j][i][1] = tex[iIdx*texWidth*3 + jIdx*3 + 1];
            texTiled[j][i][2] = tex[iIdx*texWidth*3 + jIdx*3 + 2];
        }
    }
    // Bitmap version of texture
    bitmap_image img(608, 684);
    for(unsigned int j=0; j<608; j++)
        for(unsigned int i=0; i<684; i++)
            img.set_pixel(j, i, texTiled[j][i][0], texTiled[j][i][1], texTiled[j][i][2]);

    // Save
    img.save_image("tex.bmp");

    // Set as pattern
    res = LCR_CMD_DefinePatternBMP(patternNumber, "tex.bmp");
    HandleResult(res,"LCR_CMD_DefinePattern()")
}

void ProjectorLC3000::displayPattern(unsigned int patternNumber){
    // Set display mode
//    res = LCR_CMD_SetDisplayMode(DISP_MODE_PTN_SEQ);
//    HandleResult(res,"LCR_CMD_SetDisplayMode()")

    res = LCR_CMD_DisplayPattern(patternNumber);
    HandleResult(res,"LCR_CMD_DisplayPattern()")
}

void ProjectorLC3000::displayTexture(const unsigned char *tex, unsigned int texWidth, unsigned int texHeight){
//    // Set display to image/static color
//    res = LCR_CMD_SetDisplayMode(DISP_MODE_IMAGE);
//    HandleResult(res,"LCR_CMD_SetDisplayMode()")

//    // Tile texture
//    char texTiled[608][684][3];
//    for(unsigned int j=0; j<608; j++){
//        int jIdx = j%texWidth;
//        for(unsigned int i=0; i<684; i++){
//            int iIdx = i%texHeight;
//            texTiled[j][i][0] = tex[iIdx*texWidth*3 + jIdx*3 + 0];
//            texTiled[j][i][1] = tex[iIdx*texWidth*3 + jIdx*3 + 1];
//            texTiled[j][i][2] = tex[iIdx*texWidth*3 + jIdx*3 + 2];
//        }
//    }
//    // Bitmap version of texture
//    bitmap_image img(608, 684);
//    for(unsigned int j=0; j<608; j++)
//        for(unsigned int i=0; i<684; i++)
//            img.set_pixel(j, i, texTiled[j][i][0], texTiled[j][i][1], texTiled[j][i][2]);

//    // Save
//    img.save_image("tex.bmp");

//    // Display
//    res = LCR_CMD_DisplayStaticImage("tex.bmp");
//    HandleResult(res,"LCR_CMD_DisplayStaticImage()")

    patternSeqSettings.NumPatterns = 1;
    this->setPattern(0, tex, texWidth, texHeight);
    this->displayPattern(0);

}

void ProjectorLC3000::displayBlack(){
    // Set display to image/static color
    res = LCR_CMD_SetDisplayMode(DISP_MODE_IMAGE);
    HandleResult(res,"LCR_CMD_SetDisplayMode()")

    res = LCR_CMD_DisplayStaticColor(0);
    HandleResult(res,"LCR_CMD_DisplayStaticColor()")
}

void ProjectorLC3000::displayWhite(){
    // Set display to image/static color
    res = LCR_CMD_SetDisplayMode(DISP_MODE_IMAGE);
    HandleResult(res,"LCR_CMD_SetDisplayMode()")

    res = LCR_CMD_DisplayStaticColor((255 << 16) |  (255 << 8) | (255));
    HandleResult(res,"LCR_CMD_DisplayStaticColor()")
}

void ProjectorLC3000::getScreenRes(unsigned int *nx, unsigned int *ny){
    *nx = 608;
    *ny = 684;
}

ProjectorLC3000::~ProjectorLC3000(){
    res = LCR_CMD_Close();
    HandleResult(res,"LCR_CMD_Close()")
}