import java.util.ArrayList;

/**
 * Biedt een makkelijke interface om data weer te geven op het GUIBoard
 * 
 * @author Kenneth van Ewijk
 * @author Janco Kock
 */
public class GUIboard {
    
    /**
     * Initaliseert de verbinding met het GUIBoard
     */
    public static void init()
    {
        IO.init();
    }

    /**
     * Schrijft een getal naar de bovenste digits van het GUIBoard
     * 
     * @param number Het getal dat je wilt weergeven
     */
    public static void writeUpperDigits(double number){
        clearTop();
        
        int checkNumber = String.valueOf(Math.round(number)).length();
        
        if(checkNumber <= 5){
            checkNumber = 5 - checkNumber > 0 ? 5 - checkNumber : 0;
            number = number * Math.pow(10, checkNumber);
            number = Math.round(number);
            number = number / Math.pow(10, checkNumber);
        }
        else
        {
            number = 0;
        }
        
        writeDigits(number, 0x10, 0x18);
    }
    
    /**
     * Schrijft een getal naar de linker digits van het GUIBoard
     * 
     * @param number Het getal dat je wilt weergeven
     */
    public static void writeLeftDigits(double number){
        clearLeft();
        
        int checkNumber = String.valueOf(Math.round(number)).length();
        
        if(checkNumber <= 3){
            checkNumber = 3 - checkNumber > 0 ? 3 - checkNumber : 0;
            number = number * Math.pow(10, checkNumber);
            number = Math.round(number);
            number = number / Math.pow(10, checkNumber);
        }
        else
        {
            number = 0;
        }
        
        writeDigits(number, 0x20, 0x24);
    }
    
    /**
     * Schrijft een getal naar de rechter digits van het GUIBoard
     * 
     * @param number Het getal dat je wilt weergeven
     */
    public static void writeRightDigits(double number){
        clearRight();
        
        int checkNumber = String.valueOf(Math.round(number)).length();
        
        if(checkNumber <= 3){
            checkNumber = 3 - checkNumber > 0 ? 3 - checkNumber : 0;
            number = number * Math.pow(10, checkNumber);
            number = Math.round(number);
            number = number / Math.pow(10, checkNumber);
        }
        else
        {
            number = 0;
        }
        
        writeDigits(number, 0x30, 0x34);
    }
    
    /**
     * Private methode die het schrijven van een getal naar een digit uitvoert
     * 
     * @param number Het getal dat je wilt weergeven
     * @param firstSegment De digit waar begonnen moet worden
     * @param lastSegment De digit waar geëindigd moet worden
     */
    private static void writeDigits(double number, int firstSegment, int lastSegment){
        String numberString = "";
        //Segments
         int segA = 0x01;
         int segB = 0x02;
         int segC = 0x04;
         int segD = 0x08;
         int segE = 0x10;
         int segF = 0x20;
         int segG = 0x40;
         int segDP = 0x80;
        
        //Digits
        int[] digits = {
        segA | segB | segC | segD | segE | segF,        //0
        segB | segC,                                    //1
        segA | segB | segG | segE | segD,               //2
        segA | segB | segC | segG | segD,               //3
        segB | segC | segF | segG | segC,               //4
        segA | segF | segG | segC | segD,               //5
        segA | segF | segG | segC | segD | segE,        //6
        segA | segB | segC,                             //7
        segA | segB | segC | segD | segE | segF | segG, //8
        segA | segF | segG | segC | segD | segB,        //9
        };
        
        int digit = firstSegment;
        
        if( number == 0 || (number % (int)number == 0)){
            numberString = String.valueOf((int)number);
        }else{
            numberString = String.valueOf(number);
        }
        
        
        char numberSplit[] = numberString.toCharArray();
        
        for(int i = numberSplit.length-1; i >= 0; i--){ 
            if(numberSplit[i] == '.'){
                IO.writeShort(digit, digits[(Character.getNumericValue(numberSplit[i - 1]))]|0x180);    //display a . with the next number
                i--;
            }else if(numberSplit[i] == '-'){
                IO.writeShort(digit, 0x140);            //will display a -
            }else{
                IO.writeShort(digit, Character.getNumericValue(numberSplit[i]));
            }
            digit += 2;                                 //Next digits screen
            if(digit > lastSegment){                    //If there are more then max digits needed, it will stop.
                break;
            }
        }
    }

    /**
     * Schrijft een standaard pagina naar het matrix scherm van het GUIBoard
     * 
     * @param regel1 De tekst die je op de eerste regel wilt weergeven. Normaliter de naam
     * @param regel2 De tekst die je op de tweede regel wilt weergeven.
     * @param regel3 De tekst die je op de derde regel wilt weergeven. Wordt standaard gevolgd door de navigatie.
     */
    public static boolean writePageToMatrix(String regel1, String regel2, String regel3, boolean pPeriod, boolean pScreen, double batt)
    {
        clearBottom();
        regel3 = "  " + regel3;
        if(regel1.length() > 20 && regel2.length() > 20 && regel3.length() > 12) //check if the length is not to long
        {
            return false;
        }
        
        char[] regel1CharArray = regel1.toCharArray();
        char[] regel2CharArray = regel2.toCharArray();
        char[] regel3CharArray = regel3.toCharArray();
        
        double centerMargins = 20-regel1CharArray.length;
        int centerLeft = (int) Math.floor(centerMargins/2.0);
        
        double centerMargins2 = 20-regel2CharArray.length;
        int centerLeft2 = (int) Math.floor(centerMargins2/2.0);
        
        
        for(int i=0; i<centerLeft; i++)
        {
            IO.writeShort(0x40, ' ');
        }
        for(char ch : regel1CharArray)
        {
            IO.writeShort(0x40, ch);
        }
        
        IO.writeShort(0x40, '\n');
        
        for(int i=0; i<centerLeft2; i++)
        {
            IO.writeShort(0x40, ' ');
        }
        for(char ch : regel2CharArray)
        {
            IO.writeShort(0x40, ch);
        }
        
        IO.writeShort(0x40, '\n');
        
        for(char ch : regel3CharArray)
        {
            IO.writeShort(0x40, ch);
        }
        
        createNav(pPeriod, pScreen);
        createBattery(batt);
        
        return true;
    }
    
    private static void createBattery(double batt)
    {
        //Left
        IO.writeShort(0x42, 1 << 12 | 3 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 3 << 5 | 27);
        IO.writeShort(0x42, 1 << 12 | 3 << 5 | 26);
        IO.writeShort(0x42, 1 << 12 | 3 << 5 | 25);
        IO.writeShort(0x42, 1 << 12 | 3 << 5 | 24);
        IO.writeShort(0x42, 1 << 12 | 3 << 5 | 23);
        
        //Right
        IO.writeShort(0x42, 1 << 12 | 7 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 7 << 5 | 27);
        IO.writeShort(0x42, 1 << 12 | 7 << 5 | 26);
        IO.writeShort(0x42, 1 << 12 | 7 << 5 | 25);
        IO.writeShort(0x42, 1 << 12 | 7 << 5 | 24);
        IO.writeShort(0x42, 1 << 12 | 7 << 5 | 23);
        
        //Bottom
        IO.writeShort(0x42, 1 << 12 | 4 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 5 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 6 << 5 | 28);
        
        //Top
        IO.writeShort(0x42, 1 << 12 | 4 << 5 | 22);
        IO.writeShort(0x42, 1 << 12 | 6 << 5 | 22);
        IO.writeShort(0x42, 1 << 12 | 4 << 5 | 21);
        IO.writeShort(0x42, 1 << 12 | 5 << 5 | 21);
        IO.writeShort(0x42, 1 << 12 | 6 << 5 | 21);
        
        if(batt > 1.0)
        {
            IO.writeShort(0x42, 1 << 12 | 4 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 5 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 6 << 5 | 27);
        }
        if(batt > 2.0)
        {
            IO.writeShort(0x42, 1 << 12 | 4 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 5 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 6 << 5 | 26);
        }
        if(batt > 3.0)
        {
            IO.writeShort(0x42, 1 << 12 | 4 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 5 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 6 << 5 | 25);
        }
        if(batt > 4.0)
        {
            IO.writeShort(0x42, 1 << 12 | 4 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 5 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 6 << 5 | 24);
        }
        if(batt > 4.8)
        {
            IO.writeShort(0x42, 1 << 12 | 4 << 5 | 23);
            IO.writeShort(0x42, 1 << 12 | 5 << 5 | 23);
            IO.writeShort(0x42, 1 << 12 | 6 << 5 | 23);
        }
        if(batt > 5.0)
        {
            IO.writeShort(0x42, 1 << 12 | 5 << 5 | 22);
        }
    }
    
    private static void createNav(boolean pPeriod, boolean pScreen)
    {
        //Draw the play/pause
        if(pPeriod)
        {
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 28);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 23);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 22);
            
            IO.writeShort(0x42, 1 << 12 | 77 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 77 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 77 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 77 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 77 << 5 | 23);
            
            IO.writeShort(0x42, 1 << 12 | 78 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 78 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 78 << 5 | 24);
            
            IO.writeShort(0x42, 1 << 12 | 79 << 5 | 25);
        }
        else
        {
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 28);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 23);
            IO.writeShort(0x42, 1 << 12 | 76 << 5 | 22);
            
            IO.writeShort(0x42, 1 << 12 | 79 << 5 | 28);
            IO.writeShort(0x42, 1 << 12 | 79 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 79 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 79 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 79 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 79 << 5 | 23);
            IO.writeShort(0x42, 1 << 12 | 79 << 5 | 22);
        }
        
        if(pScreen)
        {
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 28);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 23);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 22);
            
            IO.writeShort(0x42, 1 << 12 | 97 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 97 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 97 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 97 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 97 << 5 | 23);
            
            IO.writeShort(0x42, 1 << 12 | 98 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 98 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 98 << 5 | 24);
            
            IO.writeShort(0x42, 1 << 12 | 99 << 5 | 25);
        }
        else
        {
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 28);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 23);
            IO.writeShort(0x42, 1 << 12 | 96 << 5 | 22);
            
            IO.writeShort(0x42, 1 << 12 | 99 << 5 | 28);
            IO.writeShort(0x42, 1 << 12 | 99 << 5 | 27);
            IO.writeShort(0x42, 1 << 12 | 99 << 5 | 26);
            IO.writeShort(0x42, 1 << 12 | 99 << 5 | 25);
            IO.writeShort(0x42, 1 << 12 | 99 << 5 | 24);
            IO.writeShort(0x42, 1 << 12 | 99 << 5 | 23);
            IO.writeShort(0x42, 1 << 12 | 99 << 5 | 22);
        }
        
        //Grafiek knop
        IO.writeShort(0x42, 1 << 12 | 113 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 113 << 5 | 27);
        IO.writeShort(0x42, 1 << 12 | 113 << 5 | 26);
        IO.writeShort(0x42, 1 << 12 | 113 << 5 | 25);
        IO.writeShort(0x42, 1 << 12 | 113 << 5 | 24);
        IO.writeShort(0x42, 1 << 12 | 113 << 5 | 23);
        IO.writeShort(0x42, 1 << 12 | 113 << 5 | 22);
        
        IO.writeShort(0x42, 1 << 12 | 114 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 114 << 5 | 24);
        
        IO.writeShort(0x42, 1 << 12 | 115 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 115 << 5 | 25);
        
        IO.writeShort(0x42, 1 << 12 | 116 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 116 << 5 | 26);
        
        IO.writeShort(0x42, 1 << 12 | 117 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 117 << 5 | 25);
        
        IO.writeShort(0x42, 1 << 12 | 118 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 118 << 5 | 24);
        
        IO.writeShort(0x42, 1 << 12 | 119 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 119 << 5 | 23);
        
        IO.writeShort(0x42, 1 << 12 | 120 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 120 << 5 | 24);
        
        IO.writeShort(0x42, 1 << 12 | 121 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 121 << 5 | 25);
        
        IO.writeShort(0x42, 1 << 12 | 122 << 5 | 28);
        IO.writeShort(0x42, 1 << 12 | 122 << 5 | 26);
    }
    
    
    /**
     * Schrijft een grafiek naar het matrix display van het GUIBoard
     * 
     * @param msList ArrayList met alle meetwaarden die je wilt weergeven in grafiekvorm
     * @param min De minimale waarden die bij msList hoort
     * @param max De maximale waarden die bij msList hoort
     */
    public static void writeGraphToMatrix(ArrayList<Double> msList, double min, double max)
    {
        clearBottom();
        
        msList = normalizeData(msList, (max-min)/32);
        max = StatisticsCalculator.max(msList)+1;
        min = StatisticsCalculator.min(msList)-1 > 0 ? StatisticsCalculator.min(msList)-1 : StatisticsCalculator.min(msList);
        
        createAxis(min,max);
        
        int x,y;
        double getal;
        for(double i=0;i<msList.size();i++)
        {
            getal = msList.get((int)i);
            x = (int)(i/(msList.size()-1)*127.0);
            double temp = ((getal - min)/(max-min));
            y = (int)(temp*31.0);
            y = 31 - y;
            IO.writeShort(0x42, 1 << 12 | x << 5 | y );
        }
    }
    
    /**
     * Berekent of er assen moeten worden getekend. Zo ja, berekent ook waar en tekent ze vervolgens.
     * 
     * @param min De minimale waarden die zal worden weergegeven
     * @param max De maximale waarden die zal worden weergegeven
     */
    public static void createAxis(double min, double max)
    {        
        int x,y;
        double diff = max-min;
        double valpix = diff/32;
            
        if(min<=0){
            if(min==0)
            {
                y = 31;
            }
            else
            {
                y = (int) ( (diff-max) / valpix);
                y = 31 - y;
            }
            for(int x2 = 0; x2 < 128; x2++)
            {
                IO.writeShort(0x42, 1 << 12 | x2 << 5 | y );
            }
        }
    }
    
    /**
     * Probeert de data te controleren en aan te passen om een vloeierende grafiek te kunnen tekenen
     * 
     * @param data2 ArrayList met alle meetwaarden die je wilt weergeven in grafiekvorm
     * @param margin Waarde die aangeeft wanneer een waarde teveel afwijkt van het berekende gemiddelde
     * 
     * @return ArrayList met genormaliseerde data
     */
    private static ArrayList<Double> normalizeData(ArrayList<Double> data2 , double margin){
        
        ArrayList<Double> data = new ArrayList<Double>();
        
        int deler = data2.size() / 256; //Delen door het aantal punten dat je over wil houden.
        double avg=0;
        
        for(int q=0;q<data2.size(); q++)
        {
            if(q%deler==0)
            {
                avg /= deler;
                data.add(avg);
                avg=0;
            }
            avg += data2.get(q);
        }
        
        
        double prevPrevVal = 0.0, prevVal = 0.0, nextVal = 0.0, nextNextVal = 0.0, avrVal = 0.0, setVal = 0.0;
        
        for(int i = 0; i < data.size(); i ++){
            if(i + 1 < data.size()){
                nextVal = data.get(i+1);
            }
            if(i + 2 < data.size()){
                nextNextVal = data.get(i+2);
            }
            if(prevPrevVal != 0 && prevVal != 0 && nextVal != 0 && nextNextVal != 0){
                avrVal = (prevPrevVal + prevVal + nextVal + nextNextVal) / 4;
                if((data.get(i) - avrVal) >= margin){
                    setVal = avrVal;
                }else{
                    setVal = data.get(i);
                }
            }else{
                setVal = data.get(i);
            }
            
            data.set(i, setVal);
            prevVal = data.get(i);
            
            if(i - 1 >= 0){
                prevPrevVal = data.get(i-1);
            }
        }
        
        return data;
    }
    
    /**
     * Wis de bovenste digits
     */
    public  static void clearTop()
    {
         IO.writeShort(0x10, 0x100 | 0x0);
         IO.writeShort(0x12, 0x100 | 0x0);
         IO.writeShort(0x14, 0x100 | 0x0);
         IO.writeShort(0x16, 0x100 | 0x0);
         IO.writeShort(0x18, 0x100 | 0x0);
    }
    
    /**
     * Wis de linker digits
     */
    public  static void clearLeft()
    {
        IO.writeShort(0x24, 0x100 | 0x0);
        IO.writeShort(0x22, 0x100 | 0x0);
        IO.writeShort(0x20, 0x100 | 0x0);
    }
    
    /**
     * Wis de rechter digits
     */
    public  static void clearRight()
    {
        IO.writeShort(0x34, 0x100 | 0x0);
        IO.writeShort(0x32, 0x100 | 0x0);
        IO.writeShort(0x30, 0x100 | 0x0);
    }
    
    /**
     * Wis het matrix display
     */
    public static void clearBottom()
    {
        IO.writeShort(0x40, 0xFE);
        IO.writeShort(0x40, 0x01);
        IO.writeShort(0x42, 3 << 12);
    }
}