linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * Intel(R) Trace Hub PTI output driver

 *

 * Copyright (C) 2014-2016 Intel Corporation.

 */

​

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

​

#include <linux/types.h>

#include <linux/module.h>

#include <linux/device.h>

#include <linux/sizes.h>

#include <linux/printk.h>

#include <linux/slab.h>

#include <linux/mm.h>

#include <linux/io.h>

​

#include "intel_th.h"

#include "pti.h"

​

struct pti_device {

    void __iomem        *base;

    struct intel_th_device  *thdev;

    unsigned int        mode;

    unsigned int        freeclk;

    unsigned int        clkdiv;

    unsigned int        patgen;

    unsigned int        lpp_dest_mask;

    unsigned int        lpp_dest;

};

​

/* map PTI widths to MODE settings of PTI_CTL register */

static const unsigned int pti_mode[] = {

    0, 4, 8, 0, 12, 0, 0, 0, 16, 0, 0, 0, 0, 0, 0, 0,

};

​

static int pti_width_mode(unsigned int width)

{

    int i;

​

    for (i = 0; i < ARRAY_SIZE(pti_mode); i++)

        if (pti_mode[i] == width)

            return i;

​

    return -EINVAL;

}

​

static ssize_t mode_show(struct device *dev, struct device_attribute *attr,

             char *buf)

{

    struct pti_device *pti = dev_get_drvdata(dev);

​

    return scnprintf(buf, PAGE_SIZE, "%d\n", pti_mode[pti->mode]);

}

​

static ssize_t mode_store(struct device *dev, struct device_attribute *attr,

              const char *buf, size_t size)

{

    struct pti_device *pti = dev_get_drvdata(dev);

    unsigned long val;

    int ret;

​

    ret = kstrtoul(buf, 10, &val);

    if (ret)

        return ret;

​

    ret = pti_width_mode(val);

    if (ret < 0)

        return ret;

​

    pti->mode = ret;

​

    return size;

}

​

static DEVICE_ATTR_RW(mode);

​

static ssize_t

freerunning_clock_show(struct device *dev, struct device_attribute *attr,

               char *buf)

{

    struct pti_device *pti = dev_get_drvdata(dev);

​

    return scnprintf(buf, PAGE_SIZE, "%d\n", pti->freeclk);

}

​

static ssize_t

freerunning_clock_store(struct device *dev, struct device_attribute *attr,

            const char *buf, size_t size)

{

    struct pti_device *pti = dev_get_drvdata(dev);