linux-imx

// SPDX-License-Identifier: GPL-2.0-only

/*

 *

 * Copyright (C) 2012 ARM Limited

 */

​

#define DRVNAME "vexpress-hwmon"

#define pr_fmt(fmt) DRVNAME ": " fmt

​

#include <linux/device.h>

#include <linux/err.h>

#include <linux/hwmon.h>

#include <linux/hwmon-sysfs.h>

#include <linux/module.h>

#include <linux/of.h>

#include <linux/of_device.h>

#include <linux/platform_device.h>

#include <linux/vexpress.h>

​

struct vexpress_hwmon_data {

    struct device *hwmon_dev;

    struct regmap *reg;

};

​

static ssize_t vexpress_hwmon_label_show(struct device *dev,

        struct device_attribute *dev_attr, char *buffer)

{

    const char *label = of_get_property(dev->of_node, "label", NULL);

​

    return snprintf(buffer, PAGE_SIZE, "%s\n", label);

}

​

static ssize_t vexpress_hwmon_u32_show(struct device *dev,

        struct device_attribute *dev_attr, char *buffer)

{

    struct vexpress_hwmon_data *data = dev_get_drvdata(dev);

    int err;

    u32 value;

​

    err = regmap_read(data->reg, 0, &value);

    if (err)

        return err;

​

    return snprintf(buffer, PAGE_SIZE, "%u\n", value /

            to_sensor_dev_attr(dev_attr)->index);

}

​

static ssize_t vexpress_hwmon_u64_show(struct device *dev,

        struct device_attribute *dev_attr, char *buffer)

{

    struct vexpress_hwmon_data *data = dev_get_drvdata(dev);

    int err;

    u32 value_hi, value_lo;

​

    err = regmap_read(data->reg, 0, &value_lo);

    if (err)

        return err;

​

    err = regmap_read(data->reg, 1, &value_hi);

    if (err)

        return err;

​

    return snprintf(buffer, PAGE_SIZE, "%llu\n",

            div_u64(((u64)value_hi << 32) | value_lo,

            to_sensor_dev_attr(dev_attr)->index));

}

​

static umode_t vexpress_hwmon_attr_is_visible(struct kobject *kobj,

        struct attribute *attr, int index)

{

    struct device *dev = kobj_to_dev(kobj);

    struct device_attribute *dev_attr = container_of(attr,

                struct device_attribute, attr);

​

    if (dev_attr->show == vexpress_hwmon_label_show &&

            !of_get_property(dev->of_node, "label", NULL))

        return 0;

​

    return attr->mode;

}

​

struct vexpress_hwmon_type {

    const char *name;

    const struct attribute_group **attr_groups;

};

​

#if !defined(CONFIG_REGULATOR_VEXPRESS)

static DEVICE_ATTR(in1_label, 0444, vexpress_hwmon_label_show, NULL);

static SENSOR_DEVICE_ATTR_RO(in1_input, vexpress_hwmon_u32, 1000);

static struct attribute *vexpress_hwmon_attrs_volt[] = {

    &dev_attr_in1_label.attr,

    &sensor_dev_attr_in1_input.dev_attr.attr,