#include 
#include 
#include 
#include 
#include 

#include "lcdrunn.h"

#define MOSI PB5
#define MISO PB6
#define SCK PB7
#define CS PA0
#define CSS PA1
#define PORT_SPI  PORTA
#define CS_HIGH PORTA |= (1 << CS);
#define CS_LOW PORTA &= ~(1 << CS)
#define CS_HIGHH PORTA |= (1 << CSS);
#define CS_LOWW PORTA &= ~(1 << CSS);
#define EEMEM __attribute__((section(".eeprom")))


void InitSpi();
void SendSpi(uint8_t bajt);
uint8_t ReceiveSpi( void );
uint8_t SendAndReceive(uint8_t data);
uint16_t MCP3304(uint8_t channel, uint8_t chooseMCP);
void displayAmperage(uint32_t pomiar);
void displayVoltage(uint32_t pomiar);

int main(void)
{

    lcd_init();
    InitSpi();

        while(1)
        {
                lcd_cls();

        uint32_t pomiarU = MCP3304(0,1);
        uint32_t pomiarA = MCP3304(0,2);
        uint32_t pomiar2U = MCP3304(2,1);
        uint32_t pomiar2A = MCP3304(2,2);
        uint32_t pomiar3U = MCP3304(6,1);
        uint32_t pomiar3A = MCP3304(4,2);

        displayVoltage(pomiarU);
        displayAmperage(pomiarA);
        displayVoltage(pomiar2U);
        displayAmperage(pomiar2A);
        displayVoltage(pomiar3U);
        displayAmperage(pomiar3A);

         _delay_ms(1000);
        }

}

void displayAmperage(uint32_t pomiar)
{
        if(pomiar > 4096)
    {
                pomiar = (8192 - pomiar)/2;
                lcd_str("-");
    }

    uint32_t result = (pomiar * 2.56 / 4096) * 1000 * 10 ;// /2 dla drugiego mcp
    uint16_t unity = result % 1000;
    uint16_t dozens = result / 1000;

    lcd_int(dozens);
    lcd_str(".");

    if(unity < 10)
    {
            lcd_int(0);
            lcd_int(0);
    }
    else if( unity < 100)
    {
               lcd_int(0);
    }

    lcd_int(unity);
    lcd_str(" A ");
}

void displayVoltage(uint32_t pomiar)
{
    if(pomiar > 4096)
    {
            pomiar = (8192 - pomiar);
            lcd_str("-");
    }

    uint32_t wyn = (pomiar * 2.56 / 4096) * 32000  ;// /2 dla drugiego mcp
    uint16_t unity = wyn % 1000;
    uint16_t dozens = wyn / 1000;

    lcd_int(dozens);
    lcd_str(".");

    if(unity < 10)
    {
            lcd_int(0);
            lcd_int(0);
    }
    else if( unity < 100)
    {
            lcd_int(0);
    }

    lcd_int(unity);
    lcd_str(" V ");
}

void InitSpi()
   {
       DDRB |= (1 << MOSI) | (1 << SCK) | (1 << PB4);
       PORTB |= (1 << PB4);
       DDRA |= (1 << CS) | (1 << CSS);
       // Define the following pins as output
       //DDRA |= (1 << CS);

       SPCR = (1<        //SPSR |= (1 << SPI2X);
       CS_HIGH;
       CS_HIGHH;
   }

//wysyłanie do adc
void SendSpi(uint8_t bajt)
{
        SPDR = bajt;
        while( !(SPSR & (1 << SPIF)) );

}

//odbiór z adc
uint8_t ReceiveSpi( void )
{
        CS_HIGH;
        _delay_us(5);
        CS_LOW;
    while( !(SPSR & (1 << SPIF)) );
        return SPDR;
}


uint8_t SendAndReceive(uint8_t data)
{
        SPDR = data;
        while( !(SPSR & (1 << SPIF)) );
        return SPDR;
}

uint16_t MCP3304(uint8_t channel, uint8_t chooseMCP)
{
         uint8_t send_one = 0x08 | (channel >> 1);
         uint8_t send_two = 0x00 | (channel << 7);
         uint8_t send_three = 0x00;

         uint16_t sum;
         uint8_t wyn1;
         uint8_t wyn2;
         uint32_t fullSum = 0;

         for(int i = 0; i < 5; ++i)
         {
             if(chooseMCP == 1)
             {
               CS_LOW;
                      SendAndReceive(send_one);
                      wyn1 = SendAndReceive(send_two);
                      wyn2 = SendAndReceive(send_three);
               CS_HIGH;
             }
             else
             {
                   CS_LOWW;
                              SendAndReceive(send_one);
                              wyn1 = SendAndReceive(send_two);
                              wyn2 = SendAndReceive(send_three);
                   CS_HIGHH;
             }

             wyn1 = wyn1 & 0b00011111;

             sum = wyn1;
             sum = sum << 8;
             sum |= wyn2;

             fullSum += sum;

         }
         sum = fullSum/5;
         return sum;
}