Subversion Repositories HomeAutomation

#if act_ks0108_USE_EXTERNAL_EEPROM==1

    void storeImage(uint8_t id, uint8_t size_x , uint8_t size_y);

    void saveImageFromScreen(uint8_t id, uint8_t size_x , uint8_t size_y);

    #define MEMORY_I2C_ADDR  0x57   // 64K EEPROM - allowed addresses are 0x50 to 0x57

    #define MEMORY_ADDR_MSB  0      // start at base of memory. Next one is 0x01.

    #define MEMORY_ADDR_LSB  0      // start on a page boundary. Next one is 0x80.

    unsigned char messageBuf[MESSAGEBUF_SIZE];

#endif

#if act_ks0108_USE_EXTERNAL_EEPROM==1

//valid id is 1 to 255;

void printImage(uint8_t id, uint8_t x_start, uint8_t y_start) {

    if (id == 0 )

        return;     //id=0 not allowed

    uint16_t address = 0;

    uint16_t buf_index = 0;

    uint8_t index;

    uint8_t size_x = 0;

    uint8_t size_y = 0;

    uint16_t max_picture_size;

    index = (id>>5)&0x07;

    //find starting adress of the requested data

    switch (index) {

        case 0:

            address = (index)*1024;

            max_picture_size = 1024;

            break;

        case 1:

            address = 32768+(index)*512;

            max_picture_size = 512;

            break;

        case 2:

            address = 32768+32*512+(index)*256;

            max_picture_size = 256;

            break;

        case 3:

            address = 32768+32*512+32*256+(index)*128;

            max_picture_size = 128;

            break;

        case 4:

            address = 32768+32*512+32*256+32*128+(index)*64;

            max_picture_size = 64;

            break;

        case 5:

            address = 32768+32*512+32*256+32*128+32*64+(index)*32;

            max_picture_size = 32;

            break;

        case 6:

            address = 32768+32*512+32*256+32*128+32*64+32*32+(index)*16;

            max_picture_size = 16;

            break;

        case 7:

            address = 32768+32*512+32*256+32*128+32*64+32*32+32*16+(index)*16;

            max_picture_size = 16;

            break;

    }

    //Get size of picture (every picture has an 4 byte info-tag)

    messageBuf[0] = (MEMORY_I2C_ADDR<<TWI_ADR_BITS); // Read/write bit doesn't matter here

    messageBuf[1] = (uint8_t)(0);       // Starting address in memory

    messageBuf[2] = (uint8_t)(((id&0xe0)>>5) & 0xff);           // Starting address in memory

    TWI_Start_Random_Read( messageBuf, 129, 3 );    // Desired data length plus one (command byte).

    // Could do other actions in here, then get data.

    TWI_Read_Data_From_Buffer( messageBuf, 129 );

    size_x = messageBuf[((id&0x1f)<<2)];

    size_y = messageBuf[((id&0x1f)<<2)+1];

    //more_data = messageBuf[((id&0x1f)<<2)+2];

    //last_data = messageBuf[((id&0x1f)<<2)+3];

    // get data from eeprom

    messageBuf[0] = (MEMORY_I2C_ADDR<<TWI_ADR_BITS); // Read/write bit doesn't matter here

    messageBuf[1] = (uint8_t)((address >> 8) & 0xff);       // Starting address in memory

    messageBuf[2] = (uint8_t)(address & 0xff);       // Starting address in memory

    TWI_Start_Random_Read( messageBuf, 129, 3 );    // Desired data length plus one (command byte).

    // Could do other actions in here, then get data.

    TWI_Read_Data_From_Buffer( messageBuf, 129 );

    uint8_t jy = 0;

    uint8_t jx = 0;

    buf_index = 0;

    for (jy = 0; jy< size_y; jy+=8){

        glcdSetXY(x_start,y_start+jy);

        for (jx = 0; jx< size_x ; jx++){

            if (buf_index>=128) {   //get new data if buffer empty

                address +=128;

                messageBuf[0] = (MEMORY_I2C_ADDR<<TWI_ADR_BITS); // Read/write bit doesn't matter here

                messageBuf[1] = (uint8_t)((address >> 8) & 0xff);       // Starting address in memory

                messageBuf[2] = (uint8_t)(address & 0xff);       // Starting address in memory

                TWI_Start_Random_Read( messageBuf, 129, 3 );    // Desired data length plus one (command byte).

                // Could do other actions in here, then get data.

                TWI_Read_Data_From_Buffer( messageBuf, 129 );

                buf_index=0;

            }

            glcdWriteData(messageBuf[buf_index+1], GLCD_COLOR_CLEAR);

            buf_index++;

        }

    }

}

volatile uint8_t state;

volatile uint8_t lastId = 255;

#define IDLE    0

#define RECEIVING_DATA 1

void newImageData(StdCan_Msg_t *rxMsg) {

    //State machine for storing new data

    switch (state) {

        case IDLE:

            if (rxMsg->Header.Command == CAN_MODULE_CMD_KS0108_LCD_NEW_IMAGE)

            {

                storeImage(rxMsg->Data[0],rxMsg->Data[1],rxMsg->Data[2]);

                state = RECEIVING_DATA;

                lastId = 255;

                //response message

                rxMsg->Length = 1;

                rxMsg->Header.Command = CAN_MODULE_CMD_KS0108_LCD_ACK;

                while (StdCan_Put(rxMsg) != StdCan_Ret_OK);  

            }else {

                //error message

                rxMsg->Length = 0;

                rxMsg->Header.Command = CAN_MODULE_CMD_KS0108_LCD_ERROR;

                while (StdCan_Put(rxMsg) != StdCan_Ret_OK);  

            }

            break;

        case RECEIVING_DATA:

            if (rxMsg->Header.Command == CAN_MODULE_CMD_KS0108_LCD_IMAGE_DATA)

            {

                if (rxMsg->Data[0] == (lastId+1)) {

                    storeImage(rxMsg->Data[0],rxMsg->Data[1],rxMsg->Data[2]);

                    state = RECEIVING_DATA;

                    lastId++;

                    //FIXME: call function that handles the data

                    //response message

                    rxMsg->Length = 1;

                    rxMsg->Header.Command = CAN_MODULE_CMD_KS0108_LCD_ACK;

                    while (StdCan_Put(rxMsg) != StdCan_Ret_OK);  

                } else {

                    //wrong id

                    rxMsg->Length = 1;

                    rxMsg->Header.Command = CAN_MODULE_CMD_KS0108_LCD_DATA_ID_ERROR;

                    rxMsg->Data[0] = (lastId+1);

                    while (StdCan_Put(rxMsg) != StdCan_Ret_OK);  

                }

            } else if (rxMsg->Header.Command == CAN_MODULE_CMD_KS0108_LCD_DATA_DONE) {

                //Call function to flush eeprom cache

                //FIXME

                state=IDLE;

            } else {

                //error message

                rxMsg->Length = 0;

                rxMsg->Header.Command = CAN_MODULE_CMD_KS0108_LCD_ERROR;

                while (StdCan_Put(rxMsg) != StdCan_Ret_OK);  

            }

            break;

    }

}

//valid id is 1 to 255;

void storeImage(uint8_t id, uint8_t size_x , uint8_t size_y) {

    if (id == 0 )

        return;     //id=0 not allowed

    //uint16_t address = 0;

    //uint16_t buf_index = 0;

    uint8_t index;

    //uint16_t max_picture_size;

    index = (id>>5)&0x07;

    //find starting adress of the requested data

    //Get size of picture (every picture has an 4 byte info-tag)

    messageBuf[0] = (MEMORY_I2C_ADDR<<TWI_ADR_BITS); // Read/write bit doesn't matter here

    messageBuf[1] = (uint8_t)(0);       // Starting address in memory

    messageBuf[2] = (uint8_t)(((id&0xe0)>>5) & 0xff);           // Starting address in memory

    TWI_Start_Random_Read( messageBuf, 129, 3 );    // Desired data length plus one (command byte).

    // Could do other actions in here, then get data.

    TWI_Read_Data_From_Buffer( messageBuf, 129 );

    messageBuf[((id&0x1f)<<2)+1] = size_x;

    messageBuf[((id&0x1f)<<2)+2] = size_y;

    //more_data = messageBuf[((id&0x1f)<<2)+2];

    //last_data = messageBuf[((id&0x1f)<<2)+3];

    //move data in the buffer

    for (index = 128; index > 0; index--) {

        messageBuf[index+2] = messageBuf[index];

    }

    messageBuf[0] = (MEMORY_I2C_ADDR<<TWI_ADR_BITS) | (FALSE<<TWI_READ_BIT);

    messageBuf[1] = (uint8_t)(0);       // Starting address in memory

    messageBuf[2] = (uint8_t)(((id&0xe0)>>5) & 0xff);           // Starting address in memory

    TWI_Start_Read_Write( messageBuf, 131 );

    // Should wait for completion of EEPROM write cycle. Blinking the LED will do this.

    while ( TWI_Transceiver_Busy() );    // Check for an error.

    //Now the info-tag is written, only to add data left

    //FIXME........ FIX!!!

}

//valid id is 1 to 255;

void saveImageFromScreen(uint8_t id, uint8_t size_x , uint8_t size_y) {

    if (id == 0 )

        return;     //id=0 not allowed

    uint16_t max_picture_size;

    uint8_t index;

    uint8_t bufferIndex;

    uint16_t address = 0;

    index = (id>>5)&0x07;

    //find starting adress of the requested data

    switch (index) {

        case 0:

            address = (index)*1024;

            max_picture_size = 1024;

            break;

        case 1:

            address = 32768+(index)*512;

            max_picture_size = 512;

            break;

        case 2:

            address = 32768+32*512+(index)*256;

            max_picture_size = 256;

            break;

        case 3:

            address = 32768+32*512+32*256+(index)*128;

            max_picture_size = 128;

            break;

        case 4:

            address = 32768+32*512+32*256+32*128+(index)*64;

            max_picture_size = 64;

            break;

        case 5:

            address = 32768+32*512+32*256+32*128+32*64+(index)*32;

            max_picture_size = 32;

            break;

        case 6:

            address = 32768+32*512+32*256+32*128+32*64+32*32+(index)*16;

            max_picture_size = 16;

            break;

        case 7:

            address = 32768+32*512+32*256+32*128+32*64+32*32+32*16+(index)*16;

            max_picture_size = 16;

            break;

    }

    //Get size of picture (every picture has an 4 byte info-tag)

    messageBuf[0] = (MEMORY_I2C_ADDR<<TWI_ADR_BITS); // Read/write bit doesn't matter here

    messageBuf[1] = (uint8_t)(0);       // Starting address in memory

    messageBuf[2] = (uint8_t)(((id&0xe0)>>5) & 0xff);           // Starting address in memory

    TWI_Start_Random_Read( messageBuf, 129, 3 );    // Desired data length plus one (command byte).

    // Could do other actions in here, then get data.

    TWI_Read_Data_From_Buffer( messageBuf, 129 );

    messageBuf[((id&0x1f)<<2)+1] = size_x;

    messageBuf[((id&0x1f)<<2)+2] = size_y;

    //move data in the buffer

    for (index = 128; index > 0; index--) {

        messageBuf[index+2] = messageBuf[index];

    }

    messageBuf[0] = (MEMORY_I2C_ADDR<<TWI_ADR_BITS) | (FALSE<<TWI_READ_BIT);

    messageBuf[1] = (uint8_t)(0);       // Starting address in memory

    messageBuf[2] = (uint8_t)(((id&0xe0)>>5) & 0xff);           // Starting address in memory

    TWI_Start_Read_Write( messageBuf, 131 );

    // Should wait for completion of EEPROM write cycle. Blinking the LED will do this.

    while ( TWI_Transceiver_Busy() );    // Check for an error.

    //Now the info-tag is written, only to add data left

    uint8_t  h, i ;

    messageBuf[0] = (MEMORY_I2C_ADDR<<TWI_ADR_BITS) | (FALSE<<TWI_READ_BIT);

    messageBuf[1] = (uint8_t)((address >> 8) & 0xff);       // Starting address in memory

    messageBuf[2] = (uint8_t)(address & 0xff);       // Starting address in memory

    bufferIndex = 3;

    h = 0;

    while(h+8 <= size_y) {

        h += 8;