#include "em1_drv.h"

static int em1_ioctl_fifo_write(struct em1_private_s *pv, size_t size, uint32_t *words)
{
	DECLARE_WAITQUEUE(wait, current);
	int res = -ERESTARTSYS;

	if (!em1_user_op_enter(pv, &wait, &pv->rq_wait_fifo_w,
			       EM1_BUSY_FIFO_W, TASK_INTERRUPTIBLE))
	{
		res = em1_fifo_write(pv, words, size);
		res = 0;
		pv->busy &= ~EM1_BUSY_FIFO_W;
	}

	em1_user_op_leave(pv, &wait, &pv->rq_wait_fifo_w);

	return res;
}

static int em1_ioctl_fifo_read(struct em1_private_s *pv, size_t size, uint32_t *words)
{
	DECLARE_WAITQUEUE(wait, current);
	int res = -ERESTARTSYS;

	if (!em1_user_op_enter(pv, &wait, &pv->rq_wait_fifo_r,
			       EM1_BUSY_FIFO_R, TASK_INTERRUPTIBLE))
	{
		res = em1_fifo_read(pv, words, size);
		pv->busy &= ~EM1_BUSY_FIFO_R;
	}

	em1_user_op_leave(pv, &wait, &pv->rq_wait_fifo_r);

	return res;
}

int em1_ioctl(struct inode *inode, struct file *file,
	      unsigned int cmd, unsigned long arg)
{
	struct em1_file_s *fpv = file->private_data;
	struct em1_private_s *pv = fpv->pv;

	switch ((enum em1_ioctl_cmd)cmd)
	{
          case EM1_IOCTL_FIFO_WRITE: {
		struct em1_ioctl_fifo_params p;
		uint32_t w[EM1_MAX_FIFO_PAYLOAD];

		if (copy_from_user(&p, (void*)arg, sizeof(p)))
			return -EFAULT;
		if (p.count > EM1_MAX_FIFO_PAYLOAD)
			return -EINVAL;
		if (copy_from_user(w, p.words, p.count * sizeof(uint32_t)))
			return -EFAULT;
		return em1_ioctl_fifo_write(pv, p.count, w);
	  }

	  case EM1_IOCTL_FIFO_READ: {
		struct em1_ioctl_fifo_params p;
		uint32_t w[EM1_MAX_FIFO_PAYLOAD];
		int res;

		if (copy_from_user(&p, (void*)arg, sizeof(p)))
			return -EFAULT;		
		if (p.count > EM1_MAX_FIFO_PAYLOAD)
			return -EINVAL;
		res = em1_ioctl_fifo_read(pv, p.count, w);
		if (!res && copy_to_user(p.words, w, p.count * sizeof(uint32_t)))
			return -EFAULT;
		return res;
	  }
        } 
	return 0; 
}


/*
 * Local Variables:
 * c-file-style: "linux"
 * indent-tabs-mode: t
 * tab-width: 8
 * End:
 */