#include \"mbed.h\"

Serial pc( USBTX, USBRX );

#include \"lcd_lib.h\"

// two dimensional array with fixed size font
extern uint8_t font8x8[ 256 ][ 8 ];

void printChar(char zn, char a, char b, int color){
    a = (int)a;
    b = (int)b;
        for (int y = 0; y < 8; y++){
            for (int x = 0; x < 8; x++){
                if (font8x8[zn][y] & (1 << x))
                {
                    LCD_put_pixel(x + a, y + b, color);
                }
            }
        }
    }

void printString(char *zn, char a, char b, int color){
    a = (int)a;
    b = (int)b;
    int len_str = strlen(zn);

        for (int c = 0; c < len_str; c++){
            for (int y = 0; y < 8; y++){
                for (int x = 0; x < 8; x++){
                    if (font8x8[zn[c]][y] & (1 << x))
                    {
                        LCD_put_pixel(c * 8 + x + a, y + b, color);
                    }
                }
            }
        }
}




void kruznice(char x0, char y0, char polomer, int color){
    x0 = (int)x0;
    y0 = (int)y0;
    polomer = (int)polomer;
    int x = polomer-1;
    int y = 0;
    int dx = 1;
    int dy = 1;
    int err = dx - (polomer << 1);

    while (x >= y)
    {
        LCD_put_pixel(x0 + x, y0 + y, color);
        LCD_put_pixel(x0 + y, y0 + x, color);
        LCD_put_pixel(x0 - y, y0 + x, color);
        LCD_put_pixel(x0 - x, y0 + y, color);
        LCD_put_pixel(x0 - x, y0 - y, color);
        LCD_put_pixel(x0 - y, y0 - x, color);
        LCD_put_pixel(x0 + y, y0 - x, color);
        LCD_put_pixel(x0 + x, y0 - y, color);

        if (err <= 0)
        {
            y++;
            err += dy;
            dy += 2;
        }
        if (err > 0)
        {
            x--;
            dx += 2;
            err += (-polomer << 1) + dx;
        }
    }
}

void line(char x1, char y1, char x2, char y2, int color){
    x1 = (int)x1;
    x2 = (int)x2;
    y1 = (int)y1;
    y2 = (int)y2;
    int dx, dy, p, x, y;
    dx=x2-x1;
    dy=y2-y1;
    x=x1;
    y=y1;
    p=2*dy-dx;

    while(x<x2){
        if(p>=0){
            LCD_put_pixel(x,y,color);
            y=y+1;
            p=p+2*dy-2*dx;
        }
        else{
            LCD_put_pixel(x,y,color);
            p=p+2*dy;
        }
        x=x+1;
    }

}

int RGB(int R, int G, int B){
    R >>= 3;
    G >>= 2;
    B >>= 3;
    int barva = ((R << 11) | (G << 5) | B);

    return barva;
}

int transformX(int X){   //prevest kruznici, tak at stred kruznice je v 0,0 coz je uprostred LCD
    X = 0 + 160;
    return X;
}

int transformY(int y)
{
    y = 120 + 0;
    return Y;
}


int main()
{
    LCD_init();             // LCD initialization

    LCD_clear();            // LCD clear screen

    //CTime curTime = CTime::GetCurrentTime();     // jsem jen zkoušel aktuální čas
    //ts = curTime.GetSecond();
    //tm = curTime.GetMinute();
    //th = curTime.GetHour();

    double X, Y, uhel;

    int prvky[] = {1,2,3,4,5,6,7,8,9,10,11,12};  // hodiny

    kruznice(transformX(0), transformY(0), 90, RGB(0, 255, 0));

    double x2, y2;
        const int angle = 6;
                for(int i = 0; i < 60; i++)
                {
                    double radians = angle * 3.14 / 180;  // prevod do radianu
                    X2 = 160 + 90*sin(i*radians);    // goniometricke funkce, aby si zjistil ty koncove body
                    Y2 = 120 - 90*cos(i*radians);
                    line(160, 120, X2, Y2, RGB(255, 255, 255));
                }

    double x, y, uhel;
        for (int i = 0; i<12; i++) {
            uhel = 30 * 3.14 / 180;
            X = 160 + 90*sin(i * uhel);
            Y = 120 - 90*cos(i * uhel);
            if (i==0) {
                printChar(prvky[0], X, Y, RGB(255,255,255));}
            else {
                printChar(prvky[i], X, Y, RGB(255,255,255));
            }

        }


    return 0;
}