/*
 * Copyright (C) 2011 Gilles Chanteperdrix <gch@xenomai.org>.
 *
 * This library 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 2 of the License, or (at your option) any later version.
 *
 * This library 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 library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA.
 */
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/mman.h>
#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <string.h>
#include <string.h>
#include <unistd.h>
#include <limits.h>
#include <cobalt/wrappers.h>
#include <cobalt/ticks.h>
#include <asm/xenomai/syscall.h>
#include <asm/xenomai/tsc.h>
#include <asm/xenomai/features.h>
#include <asm/xenomai/uapi/fptest.h>
#include "internal.h"

struct __xn_full_tscinfo __xn_tscinfo = {
	.kinfo = {
		.counter = NULL,
	},
};

void cobalt_arch_check_features(struct cobalt_featinfo *finfo)
{
	unsigned long phys_addr;
	unsigned page_size;
	int err, fd;
	void *addr;

	if (!cobalt_use_legacy_tsc())
		return;

	if (__xn_tscinfo.kinfo.counter != NULL)
		return;

	err = XENOMAI_SYSCALL2(sc_cobalt_archcall,
			       XENOMAI_SYSARCH_TSCINFO, &__xn_tscinfo.kinfo);
	if (err)
		early_panic("missing TSC emulation: %s",
			     strerror(-err));

	fd = __STD(open("/dev/mem", O_RDONLY | O_SYNC));
	if (fd == -1)
		early_panic("failed open(/dev/mem): %s", strerror(errno));

	page_size = sysconf(_SC_PAGESIZE);

	phys_addr = (unsigned long)__xn_tscinfo.kinfo.counter;

	addr = __STD(mmap(NULL, page_size, PROT_READ, MAP_SHARED,
			  fd, phys_addr & ~(page_size - 1)));
	if (addr == MAP_FAILED)
		early_panic("failed mmap(/dev/mem): %s", strerror(errno));

	__xn_tscinfo.kinfo.counter =
		((volatile unsigned *)
		 ((char *) addr + (phys_addr & (page_size - 1))));

	__STD(close(fd));
}

int cobalt_fp_detect(void)
{
	char buffer[1024];
	int features = 0;
	FILE *fp;

	fp = fopen("/proc/cpuinfo", "r");
	if (fp == NULL)
		return 0;

	while (fgets(buffer, sizeof(buffer), fp)) {
		if(strncmp(buffer, "Features", sizeof("Features") - 1))
			continue;
		if (strstr(buffer, "fp")) {
			features |= __COBALT_HAVE_FPU;
			break;
		}
	}

	fclose(fp);

	return features;
}