#include "ejpgl.h"unsigned char qtable[64] = {16, 8, 8, 16, 12, 8, 16, 16, 16, 16, 16, 16, 16, 16,16, 32, 32, 16, 16, 16, 16, 32, 32, 32, 32, 32, 64, 64, 64, 64, 64, 64, 64, 64, 64,64, 64, 64, 64, 64, 64, 64, 64, 64, 64, 128, 64, 64, 128, 128, 128, 128, 128, 64, 64,128, 128, 128, 128, 128, 64, 128, 128, 128};unsigned char huffmancount[4][16] = {{0x00,0x01,0x05,0x01,0x01,0x01,0x01,0x01,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00},  //standard DC table count                                    {0x00,0x02,0x01,0x03,0x03,0x02,0x04,0x03,0x05,0x05,0x04,0x04,0x00,0x00,0x01,0x7D},   //standard AC table count                                    {0x00,0x01,0x05,0x01,0x01,0x01,0x01,0x01,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00},  //standard DC table count                                    {0x00,0x02,0x01,0x03,0x03,0x02,0x04,0x03,0x05,0x05,0x04,0x04,0x00,0x00,0x01,0x7D}};  //standard AC table countunsigned char huffDCvalues[12] ={0x00,  0x01,  0x02,  0x03,  0x04,  0x05,  0x06,  0x07,  0x08,  0x09,  0x0a,  0x0b};// {0x00, 0x02, 0x03, 0x04, 0x05, 0x06, 0x0E, 0x0E, 0x0E, 0x0E, 0x0E, 0x0E};unsigned char huffACvalues[162] = {0x01, 0x02, 0x03, 0x00, 0x04, 0x11, 0x05, 0x12, 0x21, 0x31, 0x41, 0x06, 0x13, 0x51, 0x61, 0x07, 0x22, 0x71,                                0x14, 0x32, 0x81, 0x91, 0xA1, 0x08, 0x23, 0x42, 0xB1, 0xC1, 0x15, 0x52, 0xD1, 0xF0, 0x24, 0x33, 0x62, 0x72, 0x82,                                0x09, 0x0A, 0x16, 0x17, 0x18, 0x19, 0x1A, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39,                                0x3A, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, 0x4A, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59, 0x5A, 0x63, 0x64,                                0x65, 0x66, 0x67, 0x68, 0x69, 0x6A, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7A, 0x83, 0x84, 0x85, 0x86, 0x87,								0x88, 0x89, 0x8A, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98, 0x99, 0x9A, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7, 0xA8,                                0xA9, 0xAA, 0xB2, 0xB3, 0xB4, 0xB5, 0xB6, 0xB7, 0xB8, 0xB9, 0xBA, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, 0xC8, 0xC9,                                0xCA, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, 0xD7, 0xD8, 0xD9, 0xDA, 0xE1, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, 0xE7, 0xE8, 0xE9,                                0xEA, 0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, 0xF8, 0xF9, 0xFA};int writejpegheader(INFOHEADER *header, JPEGHEADER *jpegheader){        unsigned int  huffmantablesize, previoussize;        unsigned char QTcount, i, j, components, id, huffmantablecount;        unsigned short length, headerlength;        //Number of Quatization Tables        QTcount = 2;        headerlength = 12; //12 bytes are needed for the markers        huffmantablecount = 4;  //2 AC and 2 DC tables        huffmantablesize = 0;		        jpegheader->SOIMarker[0] = 0xff;        jpegheader->SOIMarker[1] = 0xd8;        //APP0 segment        jpegheader->app0.APP0Marker[0] = 0xff;        jpegheader->app0.APP0Marker[1] = 0xe0;        headerlength += 16; //APP0 marker is always 16 bytes long        jpegheader->app0.Length[0] = 0x00;        jpegheader->app0.Length[1] = 0x10;        jpegheader->app0.Identifier[0] = 0x4a;        jpegheader->app0.Identifier[1] = 0x46;        jpegheader->app0.Identifier[2] = 0x49;        jpegheader->app0.Identifier[3] = 0x46;        jpegheader->app0.Identifier[4] = 0x00;        jpegheader->app0.Version[0] = 0x01;        jpegheader->app0.Version[1] = 0x00;        jpegheader->app0.Units = 0x00;        jpegheader->app0.XDensity[0] = 0x00;        jpegheader->app0.XDensity[1] = 0x01;        jpegheader->app0.YDensity[0] = 0x00;		jpegheader->app0.YDensity[1] = 0x01;        jpegheader->app0.ThumbWidth = 0x00;        jpegheader->app0.ThumbHeight = 0x00;        //Quantization Table Segment        jpegheader->qt.QTMarker[0] = 0xff;        jpegheader->qt.QTMarker[1] = 0xdb;        length = (QTcount<<6) + QTcount + 2;        headerlength += length;        jpegheader->qt.Length[0] = (length & 0xff00)>>8;        jpegheader->qt.Length[1] = length & 0xff;       // jpegheader->qt.QTInfo = 0x00; // index = 0, precision = 0        //write Quantization table to header        i = 0;        for (id=0; id<QTcount; id++) {                jpegheader->qt.QTInfo[(id<<6)+id] = id;                for(i=0;i<64;i++) {                        jpegheader->qt.QTInfo[i+1+id+(id<<6)] = qtable[i];                }        }        //Start of Frame segment        jpegheader->sof0.SOF0Marker[0] = 0xff;        jpegheader->sof0.SOF0Marker[1] = 0xc0;        if(header->bits == 8) {                components = 0x01;        }        else {                components = 0x03;		}        length = 8 + 3*components;        headerlength += length;        jpegheader->sof0.Length[0] = (length & 0xff00) >> 8;        jpegheader->sof0.Length[1] = length & 0xff;        jpegheader->sof0.DataPrecision = 0x08;        jpegheader->sof0.ImageHeight[0] = (header->height & 0xff00) >> 8;        jpegheader->sof0.ImageHeight[1] = header->height & 0xff;        jpegheader->sof0.ImageWidth[0] = (header->width & 0xff00) >> 8;        jpegheader->sof0.ImageWidth[1] = header->width & 0xff;        jpegheader->sof0.Components  = components;        for (i=0; i < components; i++) {			jpegheader->sof0.ComponentInfo[i][0] = i+1; //color component			if(i==0) {				jpegheader->sof0.ComponentInfo[i][1] = 0x22; //4:2:0 subsampling			} else {				jpegheader->sof0.ComponentInfo[i][1] = 0x11; //4:2:0 subsampling			}            jpegheader->sof0.ComponentInfo[i][2] = (i==0)? 0x00 : 0x01; //quantization table ID		}        //Start of Huffman Table Segment        jpegheader->ht.HTMarker[0] = 0xff;        jpegheader->ht.HTMarker[1] = 0xc4;        //Set dummy HT segment length        length = 0;//tablecount*17;        jpegheader->ht.Length[0] = (length & 0xff00) >> 8;        jpegheader->ht.Length[1] = length & 0xff;        previoussize = 0;        for (id=0; id < huffmantablecount; id++) {            huffmantablesize = 0;            switch (id) {            case 0 : jpegheader->ht.HuffmanInfo[previoussize] = 0x00;                     break;            case 1 : jpegheader->ht.HuffmanInfo[previoussize] = 0x10;                     break;            case 2 : jpegheader->ht.HuffmanInfo[previoussize] = 0x01;                     break;            case 3 : jpegheader->ht.HuffmanInfo[previoussize] = 0x11;                     break;			}            for (i=1; i <= 16; i++) {                    jpegheader->ht.HuffmanInfo[i+previoussize] =  huffmancount[id][i-1];                    huffmantablesize += huffmancount[id][i-1];            }            for (i=0; i < huffmantablesize; i++) {                    jpegheader->ht.HuffmanInfo[i+previoussize+17] = (id%2 == 1)? huffACvalues[i] : huffDCvalues[i];            }            previoussize += huffmantablesize + 17;        }        //Set real HT segment length        length = 2+previoussize;        headerlength += length;        jpegheader->ht.Length[0] = (length & 0xff00) >> 8;        jpegheader->ht.Length[1] = length & 0xff;        //Reset marker segment        //Start of Scan Header Segment        jpegheader->sos.SOSMarker[0] = 0xff;        jpegheader->sos.SOSMarker[1] = 0xda;        length = 6 + (components<<1);        headerlength += length;        jpegheader->sos.Length[0] = (length & 0xff00) >> 8;        jpegheader->sos.Length[1] =  length & 0xff;        jpegheader->sos.ComponentCount = components; //number of color components in the image        jpegheader->sos.Component[0][0] = 0x01; //Y component        jpegheader->sos.Component[0][1] = 0x00; //indexes of huffman tables for Y-component        if (components == 0x03) {                jpegheader->sos.Component[1][0] = 0x02; //the CB component				jpegheader->sos.Component[1][1] = 0x11; //indexes of huffman tables for CB-component                jpegheader->sos.Component[2][0] = 0x03; //The CR component                jpegheader->sos.Component[2][1] = 0x11; //indexes of huffman tables for CR-component        }        //following bytes are ignored since progressive scan is not to be implemented        jpegheader->sos.Ignore[0] = 0x00;        jpegheader->sos.Ignore[1] = 0x3f;        jpegheader->sos.Ignore[2] = 0x00;	return headerlength;}