#include "main_base.h"

int x = 120, y = 160, dx = 1, dy = 1;
unsigned int pomiar;

void move_square_asm();
unsigned short int RGB16Pack(unsigned char,unsigned char,unsigned char);

void move_square_C()
{
        x=pomiar;
        //y+=dy;
        //if (x <= 1 || x >= 240 - 34)
        //  pomiar = -pomiar;
        //if (y <= 1 || y >= 320 - 34)
            //dy = -dy;
}

int main(void) {
    HAL_Init();
    SystemClock_Config();
    BSP_SDRAM_Init();
    LCD_Config();


        RCC->APB2ENR|=RCC_APB2ENR_TIM1EN;
        GPIOA->AFR[1]|= 1 << (0*4); // 1 - Tim2_CH1 //funkcja alternatywna wejsc (AFR), bo port moze byc i/o/adc/enkoder/inne alternatywne
        GPIOA->AFR[1]|= 1 << (1*4); // 1 - Tim2_CH2
        GPIOA->MODER |= GPIO_Mode_AF << (8*2);
        GPIOA->MODER |= GPIO_Mode_AF << (9*2); //bylo gpiob
        GPIOA->PUPDR |= GPIO_PuPd_UP << (8*2);
        GPIOA->PUPDR |= GPIO_PuPd_UP << (9*2); //bylo gpiob
        TIM1->PSC=0; // Brak preskalera
        TIM1->CNT=16; // Pocz¹tkowy stan licznika
        TIM1->SMCR=1; // Wybór trybu pracy enkodera
        TIM1->CCMR1=0x3232; /* CCxS bits = 01 - Ustawia kana³y
        CH1 i CH2 do pracy wejœciowej (CAPTURE) ICxF bits = 3 -
        ustawia rozmiar okna filtru wejœciowego */ //jeszcze go skonfigurowac?
        TIM1->ARR=32; // Rejestr prze³adowania stanu licznika
        TIM1->CR1=1; // Odblokowuje licznik
        //pomiar=TIM1->CNT;


    while (1)
    {
        pomiar=TIM1->CNT;
    Clear_And_Reload_Screen();

    #ifdef  ASM_EXMPL
        move_square_asm();
    #else
        move_square_C();
    #endif

    for (int yy = 0; yy < 32; yy++)
    {
        unsigned short int *pixel = (unsigned short int*) (LCD_BUF + x + (y + yy) * 240);

        for (int xx = 0; xx < 32; xx++)
        {
            #ifdef  ASM_EXMPL
            *pixel++ =   RGB16Pack(y >> 4, (xx + (((240 - x)) * (32 - yy) / 240)+x * yy / 240), 31 - (x >> 4));
            #else
                *pixel++ =      ((31 - ((x >> 4) & 0x1f)) << 11) | (((xx + (((240 - x)) * (32 - yy) / 240) + x * yy / 240) & 0x3f) << 5) | (((y >> 4) & 0x1f) << 0);
            #endif
        }
    }

    }
}