gauthier
c7518ecf42
git-svn-id: http://svn.eurecom.fr/openair4G/trunk@7885 818b1a75-f10b-46b9-bf7c-635c3b92a50f
120 lines
3.4 KiB
C
120 lines
3.4 KiB
C
/*******************************************************************************
|
|
OpenAirInterface
|
|
Copyright(c) 1999 - 2014 Eurecom
|
|
|
|
OpenAirInterface is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
|
|
OpenAirInterface 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 General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with OpenAirInterface.The full GNU General Public License is
|
|
included in this distribution in the file called "COPYING". If not,
|
|
see <http://www.gnu.org/licenses/>.
|
|
|
|
Contact Information
|
|
OpenAirInterface Admin: openair_admin@eurecom.fr
|
|
OpenAirInterface Tech : openair_tech@eurecom.fr
|
|
OpenAirInterface Dev : openair4g-devel@lists.eurecom.fr
|
|
|
|
Address : Eurecom, Campus SophiaTech, 450 Route des Chappes, CS 50193 - 06904 Biot Sophia Antipolis cedex, FRANCE
|
|
|
|
*******************************************************************************/
|
|
|
|
#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:
|
|
*/
|
|
|