[libpicofe.git] / linux / plat.c

#include <stdio.h>
#include <string.h>
#include <dirent.h>
#include <sys/time.h>
#include <time.h>
#include <unistd.h>
#include <sys/mman.h>

#include "../common/plat.h"


int plat_is_dir(const char *path)
{
	DIR *dir;
	if ((dir = opendir(path))) {
		closedir(dir);
		return 1;
	}
	return 0;
}

int plat_get_root_dir(char *dst, int len)
{
	extern char **g_argv;
	int j;

	strncpy(dst, g_argv[0], len);
	len -= 32; // reserve
	if (len < 0) len = 0;
	dst[len] = 0;
	for (j = strlen(dst); j > 0; j--)
		if (dst[j] == '/') { dst[j+1] = 0; break; }

	return j + 1;
}

#ifdef __GP2X__
/* Wiz has a borked gettimeofday().. */
#define plat_get_ticks_ms plat_get_ticks_ms_good
#define plat_get_ticks_us plat_get_ticks_us_good
#endif

unsigned int plat_get_ticks_ms(void)
{
	struct timeval tv;
	unsigned int ret;

	gettimeofday(&tv, NULL);

	ret = (unsigned)tv.tv_sec * 1000;
	/* approximate /= 1000 */
	ret += ((unsigned)tv.tv_usec * 4195) >> 22;

	return ret;
}

unsigned int plat_get_ticks_us(void)
{
	struct timeval tv;
	unsigned int ret;

	gettimeofday(&tv, NULL);

	ret = (unsigned)tv.tv_sec * 1000000;
	ret += (unsigned)tv.tv_usec;

	return ret;
}

void plat_sleep_ms(int ms)
{
	usleep(ms * 1000);
}

int plat_wait_event(int *fds_hnds, int count, int timeout_ms)
{
	struct timeval tv, *timeout = NULL;
	int i, ret, fdmax = -1;
	fd_set fdset;

	if (timeout_ms >= 0) {
		tv.tv_sec = timeout_ms / 1000;
		tv.tv_usec = (timeout_ms % 1000) * 1000;
		timeout = &tv;
	}

	FD_ZERO(&fdset);
	for (i = 0; i < count; i++) {
		if (fds_hnds[i] > fdmax) fdmax = fds_hnds[i];
		FD_SET(fds_hnds[i], &fdset);
	}

	ret = select(fdmax + 1, &fdset, NULL, NULL, timeout);
	if (ret == -1)
	{
		perror("plat_wait_event: select failed");
		sleep(1);
		return -1;
	}

	if (ret == 0)
		return -1; /* timeout */

	ret = -1;
	for (i = 0; i < count; i++)
		if (FD_ISSET(fds_hnds[i], &fdset))
			ret = fds_hnds[i];

	return ret;
}

void *plat_mmap(unsigned long addr, size_t size)
{
	void *req, *ret;
	req = (void *)addr;
	ret = mmap(req, size, PROT_READ|PROT_WRITE, MAP_SHARED|MAP_ANONYMOUS, -1, 0);
	if (ret == MAP_FAILED)
		return NULL;
	if (ret != req)
		printf("warning: mmaped to %p, requested %p\n", ret, req);

	return ret;
}

void plat_munmap(void *ptr, size_t size)
{
	munmap(ptr, size);
}
Commit	Line	Data
4ab30ad4	1	#include <stdio.h>
d2f29611	2	#include <string.h>
049a6b3e	3	#include <dirent.h>
4ab30ad4	4	#include <sys/time.h>
	5	#include <time.h>
	6	#include <unistd.h>
997b2e4f	7	#include <sys/mman.h>
4ab30ad4	8
049a6b3e	9	#include "../common/plat.h"
	10
	11
	12	int plat_is_dir(const char *path)
	13	{
	14	DIR *dir;
	15	if ((dir = opendir(path))) {
	16	closedir(dir);
	17	return 1;
	18	}
	19	return 0;
	20	}
	21
d2f29611	22	int plat_get_root_dir(char *dst, int len)
	23	{
	24	extern char **g_argv;
	25	int j;
	26
	27	strncpy(dst, g_argv[0], len);
	28	len -= 32; // reserve
	29	if (len < 0) len = 0;
	30	dst[len] = 0;
	31	for (j = strlen(dst); j > 0; j--)
	32	if (dst[j] == '/') { dst[j+1] = 0; break; }
	33
	34	return j + 1;
	35	}
	36
b5bfb864	37	#ifdef __GP2X__
b5bfb864	38	/* Wiz has a borked gettimeofday().. */
1eb704b6	39	#define plat_get_ticks_ms plat_get_ticks_ms_good
1eb704b6	40	#define plat_get_ticks_us plat_get_ticks_us_good
b5bfb864	41	#endif
b5bfb864	42
4ab30ad4	43	unsigned int plat_get_ticks_ms(void)
	44	{
	45	struct timeval tv;
	46	unsigned int ret;
	47
	48	gettimeofday(&tv, NULL);
	49
	50	ret = (unsigned)tv.tv_sec * 1000;
b5bfb864	51	/* approximate /= 1000 */
4ab30ad4	52	ret += ((unsigned)tv.tv_usec * 4195) >> 22;
	53
	54	return ret;
	55	}
	56
b5bfb864	57	unsigned int plat_get_ticks_us(void)
	58	{
	59	struct timeval tv;
	60	unsigned int ret;
	61
	62	gettimeofday(&tv, NULL);
	63
	64	ret = (unsigned)tv.tv_sec * 1000000;
	65	ret += (unsigned)tv.tv_usec;
	66
	67	return ret;
	68	}
	69
4ab30ad4	70	void plat_sleep_ms(int ms)
	71	{
	72	usleep(ms * 1000);
	73	}
	74
	75	int plat_wait_event(int *fds_hnds, int count, int timeout_ms)
	76	{
	77	struct timeval tv, *timeout = NULL;
	78	int i, ret, fdmax = -1;
	79	fd_set fdset;
	80
	81	if (timeout_ms >= 0) {
	82	tv.tv_sec = timeout_ms / 1000;
	83	tv.tv_usec = (timeout_ms % 1000) * 1000;
	84	timeout = &tv;
	85	}
	86
	87	FD_ZERO(&fdset);
	88	for (i = 0; i < count; i++) {
	89	if (fds_hnds[i] > fdmax) fdmax = fds_hnds[i];
	90	FD_SET(fds_hnds[i], &fdset);
	91	}
	92
	93	ret = select(fdmax + 1, &fdset, NULL, NULL, timeout);
	94	if (ret == -1)
	95	{
	96	perror("plat_wait_event: select failed");
	97	sleep(1);
	98	return -1;
	99	}
	100
	101	if (ret == 0)
	102	return -1; /* timeout */
	103
	104	ret = -1;
	105	for (i = 0; i < count; i++)
	106	if (FD_ISSET(fds_hnds[i], &fdset))
	107	ret = fds_hnds[i];
	108
	109	return ret;
	110	}
	111
997b2e4f	112	void *plat_mmap(unsigned long addr, size_t size)
	113	{
	114	void req, ret;
	115	req = (void *)addr;
	116	ret = mmap(req, size, PROT_READ\|PROT_WRITE, MAP_SHARED\|MAP_ANONYMOUS, -1, 0);
	117	if (ret == MAP_FAILED)
	118	return NULL;
	119	if (ret != req)
	120	printf("warning: mmaped to %p, requested %p\n", ret, req);
	121
	122	return ret;
	123	}
	124
	125	void plat_munmap(void *ptr, size_t size)
	126	{
	127	munmap(ptr, size);
	128	}
	129