[libpicofe.git] / linux / plat.c

#define _GNU_SOURCE
#include <stdio.h>
#include <string.h>
#include <stdarg.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)
{
	int j, ret;

	ret = readlink("/proc/self/exe", dst, len - 1);
	if (ret < 0) {
		perror("readlink");
		ret = 0;
	}
	dst[ret] = 0;

	for (j = strlen(dst); j > 0; j--)
		if (dst[j] == '/') {
			dst[++j] = 0;
			break;
		}

	return 0;
}

#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_PRIVATE|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_mremap(void *ptr, size_t oldsize, size_t newsize)
{
	void *ret;

	ret = mremap(ptr, oldsize, newsize, MREMAP_MAYMOVE);
	if (ret == MAP_FAILED)
		return NULL;
	if (ret != ptr)
		printf("warning: mremap moved: %p -> %p\n", ptr, ret);

	return ret;
}

void plat_munmap(void *ptr, size_t size)
{
	munmap(ptr, size);
}

/* lprintf */
void lprintf(const char *fmt, ...)
{
	va_list vl;

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