//*----------------------------------------------------------------------------//*      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;}