461 lines
13 KiB
C
461 lines
13 KiB
C
/*
|
|
* Copyright (C) 2005 Meilhaus Electronic GmbH (support@meilhaus.de)
|
|
*
|
|
* Source File : memain.h
|
|
* Author : GG (Guenter Gebhardt) <g.gebhardt@meilhaus.de>
|
|
*/
|
|
|
|
#ifndef _MEMAIN_H_
|
|
#define _MEMAIN_H_
|
|
|
|
#include "meinternal.h"
|
|
|
|
#include "meids.h"
|
|
#include "medebug.h"
|
|
|
|
#include "medevice.h"
|
|
/*#include "me1000_device.h"
|
|
#include "me1400_device.h"
|
|
#include "me1600_device.h"*/
|
|
#include "me4600_device.h"
|
|
/*#include "me6000_device.h"
|
|
#include "me0600_device.h"
|
|
#include "me8100_device.h"
|
|
#include "me8200_device.h"
|
|
#include "me0900_device.h"*/
|
|
#include "medummy.h"
|
|
|
|
#ifdef __KERNEL__
|
|
|
|
/*=============================================================================
|
|
PCI device table.
|
|
This is used by modprobe to translate PCI IDs to drivers.
|
|
===========================================================================*/
|
|
|
|
static struct pci_device_id me_pci_table[] __devinitdata = {
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1000, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1000_A, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1000_B, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1400, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME140A, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME140B, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME14E0, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME14EA, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME14EB, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME140C, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME140D, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1600_4U, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1600_8U, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1600_12U, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1600_16U, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME1600_16U_8I,
|
|
PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4610, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4650, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4660, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4660I, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4670, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4670I, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4670S, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4670IS, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4680, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4680I, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4680S, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME4680IS, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6004, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6008, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME600F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6014, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6018, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME601F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6034, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6038, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME603F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6104, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6108, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME610F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6114, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6118, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME611F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6134, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6138, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME613F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6044, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6048, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME604F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6054, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6058, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME605F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6074, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6078, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME607F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6144, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6148, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME614F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6154, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6158, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME615F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6174, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6178, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME617F, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6259, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME6359, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME0630, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME8100_A, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME8100_B, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME8200_A, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME8200_B, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME0940, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME0950, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
{PCI_VENDOR_ID_MEILHAUS, PCI_DEVICE_ID_MEILHAUS_ME0960, PCI_ANY_ID,
|
|
PCI_ANY_ID, 0, 0, 0},
|
|
|
|
{0}
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(pci, me_pci_table);
|
|
|
|
/*=============================================================================
|
|
USB device table.
|
|
This is used by modprobe to translate USB IDs to drivers.
|
|
===========================================================================*/
|
|
/*
|
|
static struct usb_device_id me_usb_table[] __devinitdata = {
|
|
{ USB_DEVICE(USB_VENDOR_ID_MEPHISTO_S1, USB_DEVICE_ID_MEPHISTO_S1) },
|
|
{ 0 }
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE (usb, me_usb_table);
|
|
*/
|
|
|
|
/*=============================================================================
|
|
Templates
|
|
===========================================================================*/
|
|
|
|
#define ME_LOCK_MULTIPLEX_TEMPLATE(NAME, TYPE, CALL, DEV_CALL, ARGS) \
|
|
static int CALL(struct file *filep, TYPE *arg){ \
|
|
int err = 0; \
|
|
int k = 0; \
|
|
struct list_head *pos; \
|
|
me_device_t *device; \
|
|
TYPE karg; \
|
|
\
|
|
PDEBUG("executed.\n"); \
|
|
\
|
|
err = copy_from_user(&karg, arg, sizeof(TYPE)); \
|
|
if(err){ \
|
|
PERROR("Can't copy arguments to kernel space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
\
|
|
down_read(&me_rwsem); \
|
|
\
|
|
list_for_each(pos, &me_device_list){ \
|
|
if(k == karg.device){ \
|
|
device = list_entry(pos, me_device_t, list); \
|
|
break; \
|
|
} \
|
|
k++; \
|
|
} \
|
|
\
|
|
if(pos == &me_device_list){ \
|
|
PERROR("Invalid device number specified\n"); \
|
|
karg.errno = ME_ERRNO_INVALID_DEVICE; \
|
|
} \
|
|
else{ \
|
|
spin_lock(&me_lock); \
|
|
if((me_filep != NULL) && (me_filep != filep)){ \
|
|
spin_unlock(&me_lock); \
|
|
PERROR("Resource is locked by another process\n"); \
|
|
if(karg.lock == ME_LOCK_SET) \
|
|
karg.errno = ME_ERRNO_LOCKED; \
|
|
else if(karg.lock == ME_LOCK_RELEASE) \
|
|
karg.errno = ME_ERRNO_SUCCESS; \
|
|
else{ \
|
|
PERROR("Invalid lock specified\n"); \
|
|
karg.errno = ME_ERRNO_INVALID_LOCK; \
|
|
}\
|
|
} \
|
|
else { \
|
|
me_count++; \
|
|
spin_unlock(&me_lock); \
|
|
\
|
|
karg.errno = device->DEV_CALL ARGS; \
|
|
\
|
|
spin_lock(&me_lock); \
|
|
me_count--; \
|
|
spin_unlock(&me_lock); \
|
|
} \
|
|
} \
|
|
\
|
|
up_read(&me_rwsem); \
|
|
\
|
|
err = copy_to_user(arg, &karg, sizeof(TYPE)); \
|
|
if(err){ \
|
|
PERROR("Can't copy arguments back to user space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
\
|
|
return ME_ERRNO_SUCCESS; \
|
|
}
|
|
|
|
#define ME_IO_MULTIPLEX_TEMPLATE(NAME, TYPE, CALL, DEV_CALL, ARGS) \
|
|
static int CALL(struct file *filep, TYPE *arg){ \
|
|
int err = 0; \
|
|
int k = 0; \
|
|
struct list_head *pos; \
|
|
me_device_t *device; \
|
|
TYPE karg; \
|
|
\
|
|
PDEBUG("executed.\n"); \
|
|
\
|
|
err = copy_from_user(&karg, arg, sizeof(TYPE)); \
|
|
if(err){ \
|
|
PERROR("Can't copy arguments to kernel space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
\
|
|
down_read(&me_rwsem); \
|
|
\
|
|
list_for_each(pos, &me_device_list){ \
|
|
if(k == karg.device){ \
|
|
device = list_entry(pos, me_device_t, list); \
|
|
break; \
|
|
} \
|
|
k++; \
|
|
} \
|
|
\
|
|
if(pos == &me_device_list){ \
|
|
PERROR("Invalid device number specified\n"); \
|
|
karg.errno = ME_ERRNO_INVALID_DEVICE; \
|
|
} \
|
|
else{ \
|
|
spin_lock(&me_lock); \
|
|
if((me_filep != NULL) && (me_filep != filep)){ \
|
|
spin_unlock(&me_lock); \
|
|
PERROR("Resource is locked by another process\n"); \
|
|
karg.errno = ME_ERRNO_LOCKED; \
|
|
} \
|
|
else { \
|
|
me_count++; \
|
|
spin_unlock(&me_lock); \
|
|
\
|
|
karg.errno = device->DEV_CALL ARGS; \
|
|
\
|
|
spin_lock(&me_lock); \
|
|
me_count--; \
|
|
spin_unlock(&me_lock); \
|
|
} \
|
|
} \
|
|
\
|
|
up_read(&me_rwsem); \
|
|
\
|
|
err = copy_to_user(arg, &karg, sizeof(TYPE)); \
|
|
if(err){ \
|
|
PERROR("Can't copy arguments back to user space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
\
|
|
return ME_ERRNO_SUCCESS; \
|
|
}
|
|
|
|
#define ME_QUERY_MULTIPLEX_STR_TEMPLATE(NAME, TYPE, CALL, DEV_CALL, ARGS) \
|
|
static int CALL(struct file *filep, TYPE *arg){ \
|
|
int err = 0; \
|
|
int k = 0; \
|
|
struct list_head *pos; \
|
|
me_device_t *device; \
|
|
char *msg = NULL; \
|
|
TYPE karg; \
|
|
\
|
|
PDEBUG("executed.\n"); \
|
|
\
|
|
err = copy_from_user(&karg, arg, sizeof(TYPE)); \
|
|
if(err){ \
|
|
PERROR("Can't copy arguments to kernel space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
\
|
|
down_read(&me_rwsem); \
|
|
\
|
|
list_for_each(pos, &me_device_list){ \
|
|
if(k == karg.device){ \
|
|
device = list_entry(pos, me_device_t, list); \
|
|
break; \
|
|
} \
|
|
k++; \
|
|
} \
|
|
\
|
|
if(pos == &me_device_list){ \
|
|
PERROR("Invalid device number specified\n"); \
|
|
karg.errno = ME_ERRNO_INVALID_DEVICE; \
|
|
} \
|
|
else{ \
|
|
karg.errno = device->DEV_CALL ARGS; \
|
|
if(!karg.errno){ \
|
|
if((strlen(msg) + 1) > karg.count){ \
|
|
PERROR("User buffer for device name is to little\n"); \
|
|
karg.errno = ME_ERRNO_USER_BUFFER_SIZE; \
|
|
} \
|
|
else{ \
|
|
err = copy_to_user(karg.name, msg, strlen(msg) + 1); \
|
|
if(err){ \
|
|
PERROR("Can't copy device name to user space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
} \
|
|
} \
|
|
} \
|
|
\
|
|
up_read(&me_rwsem); \
|
|
\
|
|
err = copy_to_user(arg, &karg, sizeof(TYPE)); \
|
|
if(err){ \
|
|
PERROR("Can't copy query back to user space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
\
|
|
return ME_ERRNO_SUCCESS; \
|
|
}
|
|
|
|
#define ME_QUERY_MULTIPLEX_TEMPLATE(NAME, TYPE, CALL, DEV_CALL, ARGS) \
|
|
static int CALL(struct file *filep, TYPE *arg){ \
|
|
int err = 0; \
|
|
int k = 0; \
|
|
struct list_head *pos; \
|
|
me_device_t *device; \
|
|
TYPE karg; \
|
|
\
|
|
PDEBUG("executed.\n"); \
|
|
\
|
|
err = copy_from_user(&karg, arg, sizeof(TYPE)); \
|
|
if(err){ \
|
|
PERROR("Can't copy arguments from user space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
\
|
|
down_read(&me_rwsem); \
|
|
\
|
|
list_for_each(pos, &me_device_list){ \
|
|
if(k == karg.device){ \
|
|
device = list_entry(pos, me_device_t, list); \
|
|
break; \
|
|
} \
|
|
k++; \
|
|
} \
|
|
\
|
|
if(pos == &me_device_list){ \
|
|
PERROR("Invalid device number specified\n"); \
|
|
karg.errno = ME_ERRNO_INVALID_DEVICE; \
|
|
} \
|
|
else{ \
|
|
karg.errno = device->DEV_CALL ARGS; \
|
|
} \
|
|
\
|
|
up_read(&me_rwsem); \
|
|
\
|
|
err = copy_to_user(arg, &karg, sizeof(TYPE)); \
|
|
if(err){ \
|
|
PERROR("Can't copy arguments to user space\n"); \
|
|
return -EFAULT; \
|
|
} \
|
|
\
|
|
return ME_ERRNO_SUCCESS; \
|
|
}
|
|
|
|
#endif //__KERNEL__
|
|
#endif
|