• Files
• Commits
• Log
• Graph
• Stats

/*******************************************************************************
 *	BRtc.h		Real Time Clock interface
 *			T.Barnaby,	BEAM Ltd,	19/5/04
 *******************************************************************************
 */
#include <BRtc.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <linux/rtc.h>

BRtc::BRtc(){
	ofd = -1;
	orate = 0;
}

BRtc::~BRtc(){
	if(ofd > 0)
		close(ofd);
}

BError BRtc::init(int rate){
	BError	err;
	
	orate = rate;
	
	if((ofd = open("/dev/rtc", O_RDONLY)) < 0)
		err.set(ErrorMisc, BString("Unable to open /dev/rtc: ") + strerror(errno));

	if(!err && (ioctl(ofd, RTC_IRQP_SET, orate) < 0))
		err.set(ErrorMisc, BString("Unable to set RTC rate: ") + strerror(errno));
		
	if(!err && (ioctl(ofd, RTC_PIE_ON, 0) < 0))
		err.set(ErrorMisc, BString("Unable to set RTC interrupt: ") + strerror(errno));
	return err;
}

void BRtc::wait(int delayUs){
	int		n;
	unsigned long	data;
	
	n = (orate * delayUs) / 1000000;
	if(n < 1)
		n = 1;
		
	while(n--)
		read(ofd, &data, sizeof(data));
}

BRtcThreaded::BRtcThreaded(){
	orate = 0;
}

BRtcThreaded::~BRtcThreaded(){
}

BError BRtcThreaded::init(int rate){
	BError	err;

	orate = rate;
	if(! (err = ortc.init(rate))){
		setInitStackSize(100 * 1024);
		start();
	}

	return err;
}

void* BRtcThreaded::function(){
	while(1){
		ortc.wait(1000000 / orate);
		ocond.signal();
	}
	return 0;
}

void BRtcThreaded::wait(int delayUs){
	int		n;
	
	n = (orate * delayUs) / 1000000;
	if(n < 1)
		n = 1;

	while(n--)
		ocond.wait();
}