Waitloop.cpp

/******************************************************************************************
* Copyright 2017 Ideetron B.V.
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU Lesser General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
* GNU Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public License
* along with this program.  If not, see <http://www.gnu.org/licenses/>.
******************************************************************************************/
/****************************************************************************************
* File:     Waitloop.cpp
* Author:   Gerben den Hartog
* Compagny: Ideetron B.V.
* Website:  http://www.ideetron.nl/LoRa
* E-mail:   info@ideetron.nl
****************************************************************************************/
/****************************************************************************************
* Created on:         06-01-2017
* Supported Hardware: ID150119-02 Nexus board with RFM95
****************************************************************************************/

/*
*****************************************************************************************
* INCLUDE FILES
*****************************************************************************************
*/

#include "Arduino.h"
#include "Waitloop.h"


/*
*****************************************************************************************
* Description  : Initialize Timer2
*****************************************************************************************
*/
void WaitLoop_Init()
{
  ASSR = 0x00;
  //Switch of interrupts
  TIMSK2 = 0x00;
  //Initialize timer 2 Normal operation
  TCCR2A = 0x00;
  //Set prescaler to 1:64
  TCCR2B = 0x04;
  //Set Comperator register to 1 ms
  OCR2A = 0xFA;
}


/*
*****************************************************************************************
* Description	: Waitloop for waiting a given number of miliseconds
*
* Arguments		: ms number of milisecond to wait
*****************************************************************************************
*/
void WaitLoop(unsigned int ms)
{
  unsigned int Counter = 0x0000;

  //Clear Timer 2
  TCNT2 = 0x00;
  //Clear compare flag
  TIFR2 = 0x02;

  while(Counter < ms)
  {
    if((TIFR2 & 0x02) == 0x02)
    {
      Counter++;
      //Clear timer register
      TCNT2 = 0x00;
      //Clear compare flag
      TIFR2 = 0x02;
    }
  }
}