linux-imx

/*

 * PTP 1588 clock support - sysfs interface.

 *

 * Copyright (C) 2010 OMICRON electronics GmbH

 *

 *  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.

 */

#include <linux/capability.h>

#include <linux/slab.h>

​

#include "ptp_private.h"

​

static ssize_t clock_name_show(struct device *dev,

                   struct device_attribute *attr, char *page)

{

    struct ptp_clock *ptp = dev_get_drvdata(dev);

    return snprintf(page, PAGE_SIZE-1, "%s\n", ptp->info->name);

}

static DEVICE_ATTR_RO(clock_name);

​

#define PTP_SHOW_INT(name, var)                     \

static ssize_t var##_show(struct device *dev,               \

               struct device_attribute *attr, char *page)   \

{                                   \

    struct ptp_clock *ptp = dev_get_drvdata(dev);           \

    return snprintf(page, PAGE_SIZE-1, "%d\n", ptp->info->var); \

}                                   \

static DEVICE_ATTR(name, 0444, var##_show, NULL);

​

PTP_SHOW_INT(max_adjustment, max_adj);

PTP_SHOW_INT(n_alarms, n_alarm);

PTP_SHOW_INT(n_external_timestamps, n_ext_ts);

PTP_SHOW_INT(n_periodic_outputs, n_per_out);

PTP_SHOW_INT(n_programmable_pins, n_pins);

PTP_SHOW_INT(pps_available, pps);

​

static ssize_t extts_enable_store(struct device *dev,

                  struct device_attribute *attr,

                  const char *buf, size_t count)

{

    struct ptp_clock *ptp = dev_get_drvdata(dev);

    struct ptp_clock_info *ops = ptp->info;

    struct ptp_clock_request req = { .type = PTP_CLK_REQ_EXTTS };

    int cnt, enable;

    int err = -EINVAL;

​

    cnt = sscanf(buf, "%u %d", &req.extts.index, &enable);

    if (cnt != 2)

        goto out;

    if (req.extts.index >= ops->n_ext_ts)

        goto out;

​

    err = ops->enable(ops, &req, enable ? 1 : 0);

    if (err)

        goto out;

​

    return count;

out:

    return err;

}

static DEVICE_ATTR(extts_enable, 0220, NULL, extts_enable_store);

​

static ssize_t extts_fifo_show(struct device *dev,

                   struct device_attribute *attr, char *page)

{

    struct ptp_clock *ptp = dev_get_drvdata(dev);

    struct timestamp_event_queue *queue = &ptp->tsevq;

    struct ptp_extts_event event;

    unsigned long flags;

    size_t qcnt;

    int cnt = 0;

​

    memset(&event, 0, sizeof(event));

​

    if (mutex_lock_interruptible(&ptp->tsevq_mux))

        return -ERESTARTSYS;

​

    spin_lock_irqsave(&queue->lock, flags);

    qcnt = queue_cnt(queue);

    if (qcnt) {