#define _GNU_SOURCE
#include <sched.h>
#include <string.h>
#include "pthread_impl.h"
#include "syscall.h"

int sched_setaffinity(pid_t tid, size_t size, const cpu_set_t *set)
{
#ifdef __LITEOS_A__
	if (size != sizeof(cpu_set_t)) {
		errno = EINVAL;
		return -1;
	}
	return syscall(SYS_sched_setaffinity, tid, (unsigned short)(set->__bits[0]), MUSL_TYPE_PROCESS);
#else
	return syscall(SYS_sched_setaffinity, tid, size, set);
#endif
}

int pthread_setaffinity_np(pthread_t td, size_t size, const cpu_set_t *set)
{
#ifdef __LITEOS_A__
	if (size != sizeof(cpu_set_t)) {
		return EINVAL;
	}
	return -__syscall(SYS_sched_setaffinity, td->tid, (unsigned short)(set->__bits[0]), MUSL_TYPE_THREAD);
#else
	return -__syscall(SYS_sched_setaffinity, td->tid, size, set);
#endif
}

#ifdef __LITEOS_A__
static int do_getaffinity(pid_t tid, size_t size, cpu_set_t *set, int flag)
{
	unsigned int cpuset;
	if (size != sizeof(cpu_set_t)) {
		return -EINVAL;
	}
	int ret = __syscall(SYS_sched_getaffinity, tid, &cpuset, flag);
	if (ret < 0) {
		return ret;
	}
	set->__bits[0] = (long)cpuset;
	return 0;
}
#else
static int do_getaffinity(pid_t tid, size_t size, cpu_set_t *set)
{
	long ret = __syscall(SYS_sched_getaffinity, tid, size, set);
	if (ret < 0) return ret;
	if (ret < size) memset((char *)set+ret, 0, size-ret);
	return 0;
}
#endif

int sched_getaffinity(pid_t tid, size_t size, cpu_set_t *set)
{
#ifdef __LITEOS_A__
	return __syscall_ret(do_getaffinity(tid, size, set, MUSL_TYPE_PROCESS));
#else
	return __syscall_ret(do_getaffinity(tid, size, set));
#endif
}

int pthread_getaffinity_np(pthread_t td, size_t size, cpu_set_t *set)
{
#ifdef __LITEOS_A__
	return -do_getaffinity(td->tid, size, set, MUSL_TYPE_THREAD);
#else
	return -do_getaffinity(td->tid, size, set);
#endif
}