//*----------------------------------------------------------------------------
//*      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           : obj_svctempo.c
//* Object              : service tempo
//*
//* 1.0 03/10/01 HI	    : Creation
//*----------------------------------------------------------------------------
#include "periph/system_timer/lib_st.h"
#include "services/obj_svctempo.h"

//* ====================================================================================


//* ====================================================================================


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_OpenCtlTempo
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_OpenCtlTempo( AT91PS_CtlTempo pCtlTempo, void const *pTempoTimer )
{
#ifdef DBG_DRV_TIMER
	assert(pCtlTempo);
#endif

//* Check arguments of OpenSvcTempo
	if (pCtlTempo == (AT91PS_CtlTempo)0)
		return AT91C_ERROR_OPEN_CTRLTEMPO;

//* Initialize CtlTempo fields
	pCtlTempo->pFirstTempo = (AT91PS_SvcTempo)0;
	pCtlTempo->pNewTempo =  (AT91PS_SvcTempo)0;

//* default timer = system timer
	pCtlTempo->pTimer  = (void *)pTempoTimer;

	pCtlTempo->CtlTempoStart = AT91F_STStart;
	pCtlTempo->CtlTempoStop  = AT91F_STStop;


	pCtlTempo->CtlTempoSetTime = AT91F_STSetTime;
	pCtlTempo->CtlTempoGetTime = AT91F_STGetTime;
	pCtlTempo->CtlTempoIsStart = AT91F_STIsStart;

	pCtlTempo->SvcTempoStart  = AT91F_SvcTempoStart;
	pCtlTempo->SvcTempoStop   = AT91F_SvcTempoStop;
	pCtlTempo->CtlTempoCreate = AT91F_CtlTempoCreate;
	pCtlTempo->CtlTempoRemove = AT91F_CtlTempoRemove;
	pCtlTempo->CtlTempoTick   = AT91F_CtlTempoTick;

	pCtlTempo->pPrivateData = (void *) pCtlTempo;
	return AT91C_OPEN_CTRLTEMPO_SUCCESS;
}


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_STStart
//* Object              : Start the systimer
//* Input Parameters    : void * pTimer
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_STStart(void * pTimer)
{
	AT91PS_STDesc pSysTimer = (AT91PS_STDesc)pTimer;
	AT91_STinit(pSysTimer, AT91_GetSTperiod(1000));
	return AT91C_START_OK;
}


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_STStop
//* Object              :
//* Input Parameters    : void * pTimer
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_STStop(void * pTimer)
{
	return AT91C_STOP_OK;
}


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_STSetTime
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_STSetTime(AT91PS_CtlTempo pCtrl, unsigned int NewTime)
{
	return 1;
}


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_STGetTime
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_STGetTime(AT91PS_CtlTempo pCtrl)
{
	return 1;
}


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_STIsStart
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_STIsStart(AT91PS_CtlTempo pCtrl)
{
	AT91PS_STDesc pSysTimer = (AT91PS_STDesc )pCtrl->pTimer;
	return(AT91F_StGetState(pSysTimer->st_base));
}


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_CtlTempoCreate
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_CtlTempoCreate (
					AT91PS_CtlTempo pCtrl,
					AT91PS_SvcTempo pTempo)
{
	AT91PS_CtlTempo pCtlTempo = (AT91PS_CtlTempo)(pCtrl->pPrivateData);
	AT91PS_SvcTempo pTmp;


	//* If no tempo is activated, then insert it
	// * Check that this Tempo is not already in the current list
	pTmp = pCtlTempo->pFirstTempo;
	while (pTmp) {
		if (pTmp == pTempo)
			return 0;
		pTmp = pTmp->pNextTempo;
	}

	//* Check that this Tempo is not already in the new list
	pTmp = pCtlTempo->pNewTempo;
	while (pTmp) {
		if (pTmp == pTempo)
			return 0;
		pTmp = pTmp->pNextTempo;
	}

	//* Initialize Tempo structure
	pTempo->flag = AT91E_SVCTEMPO_DIS;
	pTempo->pPreviousTempo = (AT91PS_SvcTempo) 0;
	pTempo->Start = pCtlTempo->SvcTempoStart;
	pTempo->Stop  = pCtlTempo->SvcTempoStop;
	pTempo->TickTempo   = 0;
	pTempo->ReloadTempo = 0;

	//* Insert Tempo in the list
	if ( !(pCtlTempo->pFirstTempo) ) {
		pTempo->pNextTempo = (AT91PS_SvcTempo) 0;
		pCtlTempo->pFirstTempo = pTempo;
	}
	else {
		if (pCtlTempo->pNewTempo)
			pCtlTempo->pNewTempo->pPreviousTempo = pTempo;
		pTempo->pNextTempo = pCtrl->pNewTempo;
		pCtlTempo->pNewTempo = pTempo;
	}

	return 1;
}



//*----------------------------------------------------------------------------
//* Function Name       : AT91F_CtlTempoRemove
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_CtlTempoRemove (AT91PS_CtlTempo pCtrl, AT91PS_SvcTempo pTempo)
{
	AT91PS_CtlTempo pCtlTempo = (AT91PS_CtlTempo)(pCtrl->pPrivateData);
	AT91PS_SvcTempo pCurrentTempo = pCtlTempo->pFirstTempo;	// to go throught the tempo list

	//* Remove first Tempo entry in the list
	if(pCurrentTempo == pTempo) {
		pCtlTempo->pFirstTempo = pCurrentTempo->pNextTempo;
		pCtlTempo->pFirstTempo->pPreviousTempo = (AT91PS_SvcTempo)0;
		return 1;
	}

	while( (pCurrentTempo->pNextTempo != pTempo) && (pCurrentTempo->pNextTempo != (AT91PS_SvcTempo)0 ) )
			pCurrentTempo = (pCurrentTempo->pNextTempo);

	//* No tempo to remove
	if(	pCurrentTempo->pNextTempo == (AT91PS_SvcTempo)0 )
		return 0;
	//* Remove the selected tempo and rebuild the list
	pCurrentTempo->pNextTempo = pCurrentTempo->pNextTempo->pNextTempo;
	pCurrentTempo->pNextTempo->pPreviousTempo = pCurrentTempo;
	pCtlTempo->pPrivateData = pCtlTempo;
	return 1;
}


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_CtlTempoTick
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_CtlTempoTick (AT91PS_CtlTempo pCtrl)
{
	AT91PS_CtlTempo pCtlTempo = (AT91PS_CtlTempo)(pCtrl->pPrivateData);
	AT91PS_SvcTempo pCurrentTempo;	// to go throught the tempo list

	//* Add NewTempo in FirstTempo list?
	if(pCtrl->pNewTempo != (AT91PS_SvcTempo)0 ) {
		pCurrentTempo = pCtrl->pNewTempo;
		while (pCurrentTempo->pNextTempo)
			pCurrentTempo = pCurrentTempo->pNextTempo;
		pCurrentTempo->pNextTempo = pCtlTempo->pFirstTempo;
		pCtlTempo->pFirstTempo->pPreviousTempo = pCurrentTempo;

		pCtlTempo->pFirstTempo = pCtrl->pNewTempo;
	    //* Remove NewTempo list
		pCtrl->pNewTempo = (AT91PS_SvcTempo)0;
	}

	//* Notify all the Tempo elements and executes callbacks
	pCurrentTempo = pCtlTempo->pFirstTempo;
	while (pCurrentTempo!=(AT91PS_SvcTempo)0) {
		if (pCurrentTempo->flag == AT91E_SVCTEMPO_EN) {
			if(pCurrentTempo->TickTempo > 0)
				pCurrentTempo->TickTempo--;
			if((pCurrentTempo->TickTempo  == 0) && (pCurrentTempo->TempoCallback)) {
				if (pCurrentTempo->ReloadTempo)
					pCurrentTempo->TickTempo = pCurrentTempo->ReloadTempo;
				else
					pCurrentTempo->flag = AT91E_SVCTEMPO_DIS;
				pCurrentTempo->TempoCallback(AT91C_TIMEOUT_REACHED,pCurrentTempo->pPrivateData);
			}
		}
		pCurrentTempo = pCurrentTempo->pNextTempo;
	}

	return 1;
}

//*----------------------------------------------------------------------------
//* Function Name       : AT91F_SvcTempoStart
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_SvcTempoStart (
		AT91PS_SvcTempo pSvc,
		unsigned int timeout,
		unsigned int reload,
		void (*callback) (AT91S_TempoStatus, void *),
		void *pData)
{
	pSvc->TickTempo   = timeout;
	pSvc->ReloadTempo = reload;
	pSvc->TempoCallback = callback;
	pSvc->pPrivateData = pData;
	pSvc->flag = AT91E_SVCTEMPO_EN;
	return 1;
}


//*----------------------------------------------------------------------------
//* Function Name       : AT91F_SvcTempoStop
//* Object              :
//* Input Parameters    :
//* Output Parameters   : none
//*----------------------------------------------------------------------------
AT91S_TempoStatus AT91F_SvcTempoStop (
	AT91PS_SvcTempo pSvc)
{
	pSvc->flag = AT91E_SVCTEMPO_DIS;
	return 1;
}