linux内核中的pps驱动,drivers/pps/pps.c · liang/linux - Gitee.com

/*

* PPS core file

*

*

* Copyright (C) 2005-2009 Rodolfo Giometti

*

* This program 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 2 of the License, or

* (at your option) any later version.

*

* This program 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 this program; if not, write to the Free Software

* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

*/

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include

#include

#include

#include

#include

#include

#include

#include

#include

#include

#include

#include "kc.h"

/*

* Local variables

*/

static dev_t pps_devt;

static struct class *pps_class;

static DEFINE_MUTEX(pps_idr_lock);

static DEFINE_IDR(pps_idr);

/*

* Char device methods

*/

static unsigned int pps_cdev_poll(struct file *file, poll_table *wait)

{

struct pps_device *pps = file->private_data;

poll_wait(file, &pps->queue, wait);

return POLLIN | POLLRDNORM;

}

static int pps_cdev_fasync(int fd, struct file *file, int on)

{

struct pps_device *pps = file->private_data;

return fasync_helper(fd, file, on, &pps->async_queue);

}

static long pps_cdev_ioctl(struct file *file,

unsigned int cmd, unsigned long arg)

{

struct pps_device *pps = file->private_data;

struct pps_kparams params;

void __user *uarg = (void __user *) arg;

int __user *iuarg = (int __user *) arg;

int err;

switch (cmd) {

case PPS_GETPARAMS:

dev_dbg(pps->dev, "PPS_GETPARAMS\n");

spin_lock_irq(&pps->lock);

/* Get the current parameters */

params = pps->params;

spin_unlock_irq(&pps->lock);

err = copy_to_user(uarg, &params, sizeof(struct pps_kparams));

if (err)

return -EF