/*****************************************************
This program was produced by the
CodeWizardAVR V2.04.4a Advanced
Automatic Program Generator
© Copyright 1998-2009 Pavel Haiduc, HP InfoTech s.r.l.
http://www.hpinfotech.com

Project : 
Version : 
Date    : 14.08.2011
Author  : NeVaDa
Company : 
Comments: 


Chip type               : ATmega128
Program type            : Application
AVR Core Clock frequency: 1,000000 MHz
Memory model            : Small
External RAM size       : 0
Data Stack size         : 1024
*****************************************************/

#include <mega128.h>
#include <delay.h>
#include <stdio.h>
#include <string.h>

#ifndef RXB8
#define RXB8 1
#endif

#ifndef TXB8
#define TXB8 0
#endif

#ifndef UPE
#define UPE 2
#endif

#ifndef DOR
#define DOR 3
#endif

#ifndef FE
#define FE 4
#endif

#ifndef UDRE
#define UDRE 5
#endif

#ifndef RXC
#define RXC 7
#endif

#define FRAMING_ERROR (1<<FE)
#define PARITY_ERROR (1<<UPE)
#define DATA_OVERRUN (1<<DOR)
#define DATA_REGISTER_EMPTY (1<<UDRE)
#define RX_COMPLETE (1<<RXC)

#define LED0_OFF PORTA.0 = 0
#define LED0_ON PORTA.0 = 1
#define LED1_OFF PORTA.1 = 0
#define LED1_ON PORTA.1 = 1

#ifndef TWACK
#define TWACK 3
#endif

#define TW_SLAVE_ADDRESS 0b10100100
#define TWI_DEBUG 1

// Write a character to the USART1 Transmitter
#pragma used+
void putchar1(char c)
{
    while ((UCSR1A & DATA_REGISTER_EMPTY)==0);
    UDR1=c;
}
int TWI_ACK_CHECK (int sreg)
{
    if ((TWSR == 0x28) | (sreg == 0x18) | (sreg == 0x40) | (sreg == 0x50) | (sreg == 0x60) | (sreg == 0x68) | (sreg == 0x70) | (sreg == 0x78) | (sreg == 0x80) | (sreg == 0x90)) {
        return (1);
    }
    else if ((sreg == 0x20) | (sreg == 0x30) | (sreg == 0x48) | (sreg == 0x58) | (sreg == 0x88) | (sreg == 0x98)) {
        return (0);
    }
    else {
        return (255);
    }   
}
void usart_string_write (char *str) {
    int i;
    for (i=0; i<=strlen(str); i++) {
        putchar1 (str[i]);
    } 
    putchar1 (0xD);
    putchar1 (0xA);

} 

#pragma used-

// Declare your global variables here

void main(void)
{
// Declare your local variables here
char buffer[50];
//flash char ErrMsg[]  = 'Error';

// Input/Output Ports initialization
// Port A initialization
// Func7=In Func6=In Func5=In Func4=In Func3=In Func2=In Func1=Out Func0=Out 
// State7=T State6=T State5=T State4=T State3=T State2=T State1=0 State0=0 
PORTA=0x00;
DDRA=0x03;

// Port B initialization
// Func7=In Func6=In Func5=In Func4=In Func3=In Func2=In Func1=In Func0=In 
// State7=T State6=T State5=T State4=T State3=T State2=T State1=T State0=T 
PORTB=0x00;
DDRB=0x00;

// Port C initialization
// Func7=In Func6=In Func5=Out Func4=Out Func3=Out Func2=Out Func1=Out Func0=Out 
// State7=T State6=T State5=0 State4=0 State3=0 State2=0 State1=0 State0=0 
PORTC=0x00;
DDRC=0x3F;

// Port D initialization
// Func7=In Func6=In Func5=In Func4=In Func3=In Func2=In Func1=In Func0=In 
// State7=T State6=T State5=T State4=T State3=T State2=T State1=T State0=T 
PORTD=0x00;
DDRD=0x00;

// Port E initialization
// Func7=In Func6=In Func5=In Func4=In Func3=In Func2=In Func1=In Func0=In 
// State7=T State6=T State5=T State4=T State3=T State2=T State1=T State0=T 
PORTE=0x00;
DDRE=0x00;

// Port F initialization
// Func7=In Func6=In Func5=In Func4=In Func3=In Func2=In Func1=In Func0=In 
// State7=T State6=T State5=T State4=T State3=T State2=T State1=T State0=T 
PORTF=0x00;
DDRF=0x00;

// Port G initialization
// Func4=In Func3=In Func2=In Func1=In Func0=In 
// State4=T State3=T State2=T State1=T State0=T 
PORTG=0x00;
DDRG=0x00;

// Timer/Counter 0 initialization
// Clock source: System Clock
// Clock value: Timer 0 Stopped
// Mode: Normal top=FFh
// OC0 output: Disconnected
ASSR=0x00;
TCCR0=0x00;
TCNT0=0x00;
OCR0=0x00;

// Timer/Counter 1 initialization
// Clock source: System Clock
// Clock value: Timer1 Stopped
// Mode: Normal top=FFFFh
// OC1A output: Discon.
// OC1B output: Discon.
// OC1C output: Discon.
// Noise Canceler: Off
// Input Capture on Falling Edge
// Timer1 Overflow Interrupt: Off
// Input Capture Interrupt: Off
// Compare A Match Interrupt: Off
// Compare B Match Interrupt: Off
// Compare C Match Interrupt: Off
TCCR1A=0x00;
TCCR1B=0x00;
TCNT1H=0x00;
TCNT1L=0x00;
ICR1H=0x00;
ICR1L=0x00;
OCR1AH=0x00;
OCR1AL=0x00;
OCR1BH=0x00;
OCR1BL=0x00;
OCR1CH=0x00;
OCR1CL=0x00;

// Timer/Counter 2 initialization
// Clock source: System Clock
// Clock value: Timer2 Stopped
// Mode: Normal top=FFh
// OC2 output: Disconnected
TCCR2=0x00;
TCNT2=0x00;
OCR2=0x00;

// Timer/Counter 3 initialization
// Clock source: System Clock
// Clock value: Timer3 Stopped
// Mode: Normal top=FFFFh
// OC3A output: Discon.
// OC3B output: Discon.
// OC3C output: Discon.
// Noise Canceler: Off
// Input Capture on Falling Edge
// Timer3 Overflow Interrupt: Off
// Input Capture Interrupt: Off
// Compare A Match Interrupt: Off
// Compare B Match Interrupt: Off
// Compare C Match Interrupt: Off
TCCR3A=0x00;
TCCR3B=0x00;
TCNT3H=0x00;
TCNT3L=0x00;
ICR3H=0x00;
ICR3L=0x00;
OCR3AH=0x00;
OCR3AL=0x00;
OCR3BH=0x00;
OCR3BL=0x00;
OCR3CH=0x00;
OCR3CL=0x00;

// External Interrupt(s) initialization
// INT0: Off
// INT1: Off
// INT2: Off
// INT3: Off
// INT4: Off
// INT5: Off
// INT6: Off
// INT7: Off
EICRA=0x00;
EICRB=0x00;
EIMSK=0x00;

// Timer(s)/Counter(s) Interrupt(s) initialization
TIMSK=0x00;
ETIMSK=0x00;

// USART1 initialization
// Communication Parameters: 8 Data, 1 Stop, No Parity
// USART1 Receiver: Off
// USART1 Transmitter: On
// USART1 Mode: Asynchronous
// USART1 Baud Rate: 1200
UCSR1A=0x00;
UCSR1B=0x08;
UCSR1C=0x06;
UBRR1H=0x00;
UBRR1L=0x33;

// Analog Comparator initialization
// Analog Comparator: Off
// Analog Comparator Input Capture by Timer/Counter 1: Off
ACSR=0x80;
SFIOR=0x00;

// 2 Wire Bus initialization
// Generate Acknowledge Pulse: Off
// 2 Wire Bus Slave Address: 0h
// General Call Recognition: Off
// Bit Rate: 1,901 kHz
TWSR=0x00;
TWBR=0xFF;
TWAR=0x00;
TWCR=0b11000100;

PORTC.0 = 0;
PORTC.1 = 1;
PORTC.2 = 0;

usart_string_write("");
usart_string_write("Program started.");

while (1)
    {
    LED1_ON;
    LED0_OFF;  
    usart_string_write("");
    usart_string_write("->> Begin of cycle ->>");
    delay_ms (10);
    // Place your code here   
      
    TWCR = (1<<TWINT)|(1<<TWSTA)|(1<<TWEN);
    while (!(TWCR & (1<<TWINT))) {
        if (TWI_DEBUG) {     
            sprintf (buffer, "DBG: status TWINT is: %X, waiting 1", (TWCR & (1<<TWINT)));
            usart_string_write (buffer);
        }
    }
    if (TWI_DEBUG) {     
        sprintf (buffer, "DBG: TWSR is: %X", TWSR);
        usart_string_write (buffer);
    }
    //if ((TWSR & 0xF8) != START)
      // usart_string_write("Error: ");
    TWDR = TW_SLAVE_ADDRESS | (0<<0);
    TWCR = (1<<TWINT) | (1<<TWEN);
    if (TWI_DEBUG) {     
        if (TWI_DEBUG) {     
            sprintf (buffer, "DBG: Sending address %X to TWI bus", TWDR);
            usart_string_write (buffer);
        }
    }
    while (!(TWCR & (1<<TWINT))) {
        if (TWI_DEBUG) {     
            sprintf (buffer, "DBG: status TWINT is: %X, waiting 1", (TWCR & (1<<TWINT)));
            usart_string_write (buffer);
        }
    }
    if (TWI_DEBUG) {     
        sprintf (buffer, "DBG: TWSR is: %X", TWSR);
        usart_string_write (buffer);
    }
    if (TWI_ACK_CHECK(TWSR) == 0) { 
        sprintf (buffer, "\x1B[31mERR:\x1B[0m ACK not received. TWSR is: %X", TWSR);
        usart_string_write (buffer);
    }  
    else  {
        if (TWI_DEBUG) {
            if (TWI_ACK_CHECK(TWSR) == 1) {     
                sprintf (buffer, "DBG: ACK was received");
                usart_string_write (buffer);
            }
            else
            {
                sprintf (buffer, "DBG: ACK flag unknown");
                usart_string_write (buffer);
            }
        } 
    }
    TWDR = 0xa2; 
    TWCR = (1<<TWINT) | (1<<TWEN);
    if (TWI_DEBUG) {     
        if (TWI_DEBUG) {     
            sprintf (buffer, "DBG: Sending address %X to TWI bus", TWDR);
            usart_string_write (buffer);
        }
    }
    while (!(TWCR & (1<<TWINT))) {
        if (TWI_DEBUG) {     
            sprintf (buffer, "DBG: status TWINT is: %X, waiting 1", (TWCR & (1<<TWINT)));
            usart_string_write (buffer);
        }
    }
    if (TWI_DEBUG) {     
        sprintf (buffer, "DBG: TWSR is: %X", TWSR);
        usart_string_write (buffer);
    }
    if (TWI_ACK_CHECK(TWSR) == 0) { 
        sprintf (buffer, "\x1B[31mERR:\x1B[0m ACK not received. TWSR is: %X", TWSR);
        usart_string_write (buffer);
    }  
    else  {
        if (TWI_DEBUG) {
            if (TWI_ACK_CHECK(TWSR) == 1) {     
                sprintf (buffer, "DBG: ACK was received");
                usart_string_write (buffer);
            }
            else
            {
                sprintf (buffer, "DBG: ACK flag unknown");
                usart_string_write (buffer);
            }
        } 
    }
    //TWDR = TW_SLAVE_ADDRESS | (1<<0);
    TWDR = 0xCC;
    //TWCR = (1<<TWINT)|(1<<TWSTA)|(1<<TWEN);
    TWCR = (1<<TWINT)|(1<<TWEN);
    if (TWI_DEBUG) {     
        if (TWI_DEBUG) {     
            sprintf (buffer, "DBG: Sending address %X to TWI bus", TWDR);
            usart_string_write (buffer);
        }
    }
    while (!(TWCR & (1<<TWINT))) {
        if (TWI_DEBUG) {     
            sprintf (buffer, "DBG: status TWINT is: %X, waiting 1", (TWCR & (1<<TWINT)));
            usart_string_write (buffer);
        }
    }
    if (TWI_DEBUG) {     
        sprintf (buffer, "DBG: TWSR is: %X", TWSR);
        usart_string_write (buffer);
    }
    if (TWI_ACK_CHECK(TWSR) == 0) { 
        sprintf (buffer, "\x1B[31mERR:\x1B[0m ACK not received. TWSR is: %X", TWSR);
        usart_string_write (buffer);
    }  
    else  {
        if (TWI_DEBUG) {
            if (TWI_ACK_CHECK(TWSR) == 1) {     
                sprintf (buffer, "DBG: ACK was received");
                usart_string_write (buffer);
            }
            else
            {
                sprintf (buffer, "DBG: ACK flag unknown");
                usart_string_write (buffer);
            }
        } 
    }
    
    
    
    TWCR = (1<<TWINT)|(1<<TWEN)| (1<<TWSTO);         
    
    //end of user code
    LED1_OFF;
    LED0_ON;  
    usart_string_write("<<- End of cycle <<-");
    delay_ms (5000);
    };    
}