package art.servers.etdserver.protocols.skp3;

import java.io.ByteArrayOutputStream;

public class SKP3_ProtocolWriter 
{
    public static final int STX       = 0x7E;
    public static final int ETX       = 0x7E;
    public static final int MASK      = 0x7D;
    public static final int STX_FLAG  = 0x5E;
    public static final int MASK_FLAG = 0x5D;


    // COMMAND-RESPONSE
    public static final int PING_CONTROLLER_QUERY              = 0x81;
    public static final int PING_CONTROLLER_RESPONSE           = 0x01;
    public static final int READ_SLAVE_DRIVER_VERSION_QUERY    = 0x86;
    public static final int READ_SLAVE_DRIVER_VERSION_RESPONSE = 0x06;
    public static final int RESET_SLAVE_DRIVER_QUERY           = 0xC7;
    public static final int RESET_SLAVE_DRIVER_RESPONSE        = 0x47;
    public static final int CONFIGURE_DRIVER_QUERY             = 0x8A;
    public static final int CONFIGURE_DRIVER_RESPONSE          = 0x0A;
    public static final int READ_WRITE_TIME_QUERY              = 0x8B;
    public static final int READ_WRITE_TIME_RESPONSE           = 0x0B;
    public static final int READ_STATUS_CONTROLLER_QUERY       = 0x8C;
    public static final int READ_STATUS_CONTROLLER_RESPONSE    = 0x0C;
    public static final int READ_EVENT_QUERY                   = 0x8F;
    public static final int READ_EVENT_RESPONSE                = 0x0F;
    public static final int READ_DATA_QUERY                    = 0xA0;
    public static final int READ_DATA_RESPONSE                 = 0x20;
    public static final int CLEAR_EVENTS_QUERY                 = 0xCF;
    public static final int CLEAR_EVENTS_RESPONSE              = 0x4F;
    public static final int READ_DIAGNOSIS_DATA_QUERY          = 0x90;
    public static final int READ_DIAGNOSIS_DATA_RESPONSE       = 0x10;




    // ALARMS CFG CODES
    public static final int ERROR_CFG_EXTERNAL_MEMORY = 0x01;
    public static final int ERROR_CFG_RAM             = 0x02;
    public static final int ERROR_CFG_FLASH           = 0x04;
    public static final int ERROR_CFG_FRAM            = 0x08;
    public static final int ERROR_CFG_RTC             = 0x10;
    public static final int ERROR_CFG_WIZNET          = 0x20;
    public static final int ERROR_CFG_CPLD_HW         = 0x40;
    public static final int ERROR_CFG_CPLD_SW         = 0x80;


    // ALARMS ERROR CODES
    public static final int ALARM_CFG_EXTERNAL_MEMORY_READ_ERROR   = 0xFFFF;

    public static final int ALARM_CFG_RAM_UNINITIALISED   = 0xFFFF;
    public static final int ALARM_CFG_RAM_SHORTCIRCUIT_DATA   = 0xFFFE;
    public static final int ALARM_CFG_RAM_SHORTCIRCUIT_ADDRESS   = 0xFFFD;

    public static final int ALARM_CFG_FLASH_UNINITIALISED   = 0xFFFF;
    public static final int ALARM_CFG_FLASH_LACK_COMMS   = 0xFFFE;
    public static final int ALARM_CFG_FLASH_MODEL_ERROR   = 0xFFFD;

    public static final int ALARM_CFG_FRAM_UNINITIALISED   = 0xFFFF;
    public static final int ALARM_CFG_FRAM_LACK_COMMS   = 0xFFFE;

    public static final int ALARM_CFG_RTC_UNINITIALISED   = 0xFFFF;
    public static final int ALARM_CFG_RTC_LACK_COMMS   = 0xFFFE;

    public static final int ALARM_CFG_WIZNET_UNINITIALISED   = 0xFFFF;
    public static final int ALARM_CFG_WIZNET_NO_COMMS   = 0xFFFD;

    public static final int ALARM_CFG_CPLD_HW_UNKNOWN_ERROR  = 0xFFFF;
    public static final int ALARM_CFG_CPLD_HW_WRITE_ERROR   = 0xFFFE;
    public static final int ALARM_CFG_CPLD_HW_LIMIT_EXCEEDED  = 0xFFFD;
    public static final int ALARM_CFG_CPLD_HW_UNKNOWN_COMMAND  = 0xFFFC;
    public static final int ALARM_CFG_CPLD_HW_UNKNOWN_STATE  = 0xFFFB;
    public static final int ALARM_CFG_CPLD_HW_OVERFLOW  = 0xFFFA;
    public static final int ALARM_CFG_CPLD_HW_LACK_BUFFER_SPACE1  = 0xFFF9;
    public static final int ALARM_CFG_CPLD_HW_LACK_BUFFER_SPACE2  = 0xFFF8;

    public static final int ALARM_CFG_CPLD_SW_UNKNOWN_ERROR  = 0xFFFF;
    public static final int ALARM_CFG_CPLD_SW_WRITE_ERROR   = 0xFFFE;
    public static final int ALARM_CFG_CPLD_SW_LIMIT_EXCEEDED  = 0xFFFD;
    public static final int ALARM_CFG_CPLD_SW_UNKNOWN_COMMAND  = 0xFFFC;
    public static final int ALARM_CFG_CPLD_SW_UNKNOWN_STATE  = 0xFFFB;
    public static final int ALARM_CFG_CPLD_SW_OVERFLOW  = 0xFFFA;
    public static final int ALARM_CFG_CPLD_SW_LACK_BUFFER_SPACE1  = 0xFFF9;
    public static final int ALARM_CFG_CPLD_SW_LACK_BUFFER_SPACE2  = 0xFFF8;


    // DATA IDENTIFIERS COUNTING
    public static final int DATA_ID_TOTAL_L1   = 49;
    public static final int DATA_ID_TOTAL_L2   = 51;

    // DATA IDENTIFIERS LENGTH CLASSIFICATION
    public static final int DATA_ID_K1_L1   = 7;
    public static final int DATA_ID_K1_L2   = 9;
    public static final int DATA_ID_K2_L1   = 195;
    public static final int DATA_ID_K2_L2   = 515;
    public static final int DATA_ID_K3_L1   = 196;
    public static final int DATA_ID_K3_L2   = 516;

    // DATA IDENTIFIERS SPEED
    public static final int DATA_ID_AVG_SPEED_L1   = 77;
    public static final int DATA_ID_AVG_SPEED_L2   = 78;
    public static final int DATA_ID_MAX_SPEED_L1   = 71;
    public static final int DATA_ID_MAX_SPEED_L2   = 72;

    // DATA IDENTIFIERS SPEED CLASSIFICATION
    public static final int DATA_ID_30_L1   = 334;
    public static final int DATA_ID_30_L2   = 335;
    public static final int DATA_ID_30_40_L1   = 330;
    public static final int DATA_ID_30_40_L2   = 331;
    public static final int DATA_ID_40_50_L1   = 332;
    public static final int DATA_ID_40_50_L2   = 333;
    public static final int DATA_ID_50_60_L1   = 63;
    public static final int DATA_ID_50_60_L2   = 64;
    public static final int DATA_ID_60_70_L1   = 65;
    public static final int DATA_ID_60_70_L2   = 66;
    public static final int DATA_ID_70_80_L1   = 336;
    public static final int DATA_ID_70_80_L2   = 337;
    public static final int DATA_ID_80_90_L1   = 338;
    public static final int DATA_ID_80_90_L2   = 339;
    public static final int DATA_ID_90_100_L1   = 376;
    public static final int DATA_ID_90_100_L2   = 408;
    public static final int DATA_ID_100_110_L1   = 377;
    public static final int DATA_ID_100_110_L2   = 409;
    public static final int DATA_ID_110_120_L1   = 378;
    public static final int DATA_ID_110_120_L2   = 410;
    public static final int DATA_ID_120_130_L1   = 379;
    public static final int DATA_ID_120_130_L2   = 411;
    public static final int DATA_ID_130_140_L1   = 380;
    public static final int DATA_ID_130_140_L2   = 412;
    public static final int DATA_ID_140_150_L1   = 381;
    public static final int DATA_ID_140_150_L2   = 413;
    public static final int DATA_ID_150_160_L1   = 382;
    public static final int DATA_ID_150_160_L2   = 414;
    public static final int DATA_ID_160_170_L1   = 383;
    public static final int DATA_ID_160_170_L2   = 415;
    public static final int DATA_ID_170_180_L1   = 384;
    public static final int DATA_ID_170_180_L2   = 416;
    public static final int DATA_ID_180_L1   = 385;
    public static final int DATA_ID_180_L2   = 417;


    // CFG MULTIPLIERS
    public static final int CFG_MULTIPLIER_1    = 0;
    public static final int CFG_MULTIPLIER_10   = 1;
    public static final int CFG_MULTIPLIER_100  = 2;
    public static final int CFG_MULTIPLIER_1000 = 3;


    private ByteArrayOutputStream bos = new ByteArrayOutputStream();
    
    
    public SKP3_ProtocolWriter()
    {
    }

    
    public void write(int data)
    {
        bos.write(data);
    }

    
    public void writeShort(int data)
    {
        bos.write((data >> 8) & 0xFF);
        bos.write((data & 0xFF));
    }

    
    public void writeInt(int data)
    {
        bos.write((data >> 24) & 0xFF);
        bos.write((data >> 16) & 0xFF);
        bos.write((data >> 8) & 0xFF);
        bos.write((data & 0xFF));
    }

    
    public void writeString(String data)
    {
        for (int i=0; i<data.length(); i++)
        {
            bos.write(data.charAt(i));
        }
    }
    

    public void write(int[] data)
    {
        for (int i=0; i<data.length; i++)
        {
            write(data[i]);
        }
    }


    public void writeSerialNumber(int serialNumber)
    {
        bos.write((serialNumber >> 8));
        bos.write((serialNumber & 0xFF));
    }


    public void writeHeader()
    {
        bos.write('S');
        bos.write('K');
        bos.write('P');
        bos.write('3');
    }


    public void STX()
    {
        bos.write(STX);
    }


    public void ETX()
    {
        bos.write(ETX);
    }


    public int[] applyMask(int[] command)
    {
        int newLength = 0;
        for (int i=0; i<command.length; i++)
        {
            if ((command[i] == MASK) || (command[i] == STX) || (command[i] == ETX))
                newLength++;
            newLength++;
        }

        int[] result = new int[newLength];
        int index = 0;
        for (int i=0; i<command.length; i++)
        {
            if (command[i] == MASK)
            {
                result[index++] = MASK;
                result[index++] = MASK_FLAG;
            }
            else if (command[i] == STX)
            {
                result[index++] = MASK;
                result[index++] = STX_FLAG;
            }
            else
            {
                result[index++] = command[i];
            }
        }

        return(result);
    }


    public byte[] createMessage()
    {
        SKP3_ProtocolWriter writer = new SKP3_ProtocolWriter();

        int[] command = toIntegerArray();
        writer.write(command);
        writer.write(writer.crc(command));

        return(createMessageMask(writer.applyMask(writer.toIntegerArray())));
    }


    private byte[] createMessageMask(int[] command)
    {
        SKP3_ProtocolWriter writer = new SKP3_ProtocolWriter();

        writer.write(STX);
        writer.write(command);
        writer.write(ETX);

        return(writer.toByteArray());
    }


    public int crc(int[] command)
    {
        int crc = 0;
        for (int i=0; i<command.length; i++)
            crc += command[i];
        return(crc%256);
    }
    
    

    public byte[] toByteArray()
    {
        return bos.toByteArray();
    }
            

    public int[] toIntegerArray()
    {
        byte[] data = bos.toByteArray();
        int[] result = new int[data.length];
        for (int i=0; i<data.length; i++) result[i] = (int)data[i] & 0xFF;
        return result;
    }

}