//*--------------------------------------------------------------------------------------
//*      ATMEL Microcontroller Software Support  -  ROUSSET  -
//*--------------------------------------------------------------------------------------
//* The software is delivered "AS IS" without warranty or condition of any
//* kind, either express, implied or statutory. This includes without
//* limitation any warranty or condition with respect to merchantability or
//* fitness for any particular purpose, or against the infringements of
//* intellectual property rights of others.
//*--------------------------------------------------------------------------------------
//* File Name           : twi.c
//* Object              : Basic TWI EEPROM driver
//* Translator          :
//* 1.0 25/11/02 NL		: Creation
//*--------------------------------------------------------------------------------------
#include "AT91RM9200.h"
#include "def.h"
#include "config.h"
#include "twi.h"

#ifdef	IIC_SUPPORT
//*----------------------------------------------------------------------------
//* \fn    AT91F_SetTwiClock
//* \brief Initialization
//*----------------------------------------------------------------------------
void AT91F_SetTwiClock(const AT91PS_TWI pTwi)
{
	int sclock;

	/* Here, CKDIV = 1 and CHDIV=CLDIV  ==> CLDIV = CHDIV = 1/4*((Fmclk/FTWI) -6)*/

	sclock = (10*AT91C_MASTER_CLOCK /AT91C_TWI_CLOCK);
	if (sclock % 10 >= 5)
		sclock = (sclock /10) - 5;
	else
		sclock = (sclock /10)- 6;
	sclock = (sclock + (4 - sclock %4)) >> 2;	// div 4

    pTwi->TWI_CWGR	= 0x00010000 | sclock | (sclock << 8);
}

//*=========================================================
//*		WRITE
//*=========================================================
//*----------------------------------------------------------------------------
//* \fn    AT91F_TWI_Write
//* \brief Send n bytes to a slave device
//*----------------------------------------------------------------------------
int AT91F_TWI_Write(const AT91PS_TWI pTwi ,int address, char *data2send, int size)
{
	unsigned int status;

	// Set the TWI Master Mode Register
	pTwi->TWI_MMR = ( AT91C_EEPROM_I2C_ADDRESS | AT91C_TWI_IADRSZ_2_BYTE ) & ~AT91C_TWI_MREAD;	
	
	// Set TWI Internal Address Register
	pTwi->TWI_IADR = address;

	status = pTwi->TWI_SR;
		
	pTwi->TWI_THR = *(data2send++);
	
	pTwi->TWI_CR = AT91C_TWI_START;
		
	while (size-- >1){

		// Wait THR Holding register to be empty
		while (!(pTwi->TWI_SR & AT91C_TWI_TXRDY));
	
		// Send first byte
		pTwi->TWI_THR = *(data2send++);
		
	}

	pTwi->TWI_CR = AT91C_TWI_STOP;		

	status = pTwi->TWI_SR;

	// Wait transfer is finished
    while (!(pTwi->TWI_SR & AT91C_TWI_TXCOMP));
		
	return AT91C_EEPROM_WRITE_OK;
}

//*=========================================================
//*		READ
//*=========================================================
//*----------------------------------------------------------------------------
//* \fn    AT91F_TWI_Read
//* \brief Read n bytes from a slave device
//*----------------------------------------------------------------------------
int AT91F_TWI_Read(const AT91PS_TWI pTwi , int address, char *data, int size)
{
	unsigned int status;
	
	// Set the TWI Master Mode Register
	pTwi->TWI_MMR = AT91C_EEPROM_I2C_ADDRESS | AT91C_TWI_IADRSZ_2_BYTE | AT91C_TWI_MREAD;	
	
	// Set TWI Internal Address Register
	pTwi->TWI_IADR = address;
	
	// Start transfer
	pTwi->TWI_CR = AT91C_TWI_START;
	
	status = pTwi->TWI_SR;
		
	while (size-- >1){
		
		// Wait RHR Holding register is full
		while (!(pTwi->TWI_SR & AT91C_TWI_RXRDY));

		// Read byte
		*(data++) = pTwi->TWI_RHR;
	
	}
	
	pTwi->TWI_CR = AT91C_TWI_STOP;

	status = pTwi->TWI_SR;

	// Wait transfer is finished
    while (!(pTwi->TWI_SR & AT91C_TWI_TXCOMP));

	// Read last byte
	*data = pTwi->TWI_RHR;
		
	return AT91C_EEPROM_READ_OK;
}

#endif	/* IIC_SUPPORT */