linux-imx

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

// Copyright IBM Corp 2019

​

#include <linux/bitops.h>

#include <linux/device.h>

#include <linux/hwmon-sysfs.h>

#include <linux/kernel.h>

#include <linux/sysfs.h>

​

#include "common.h"

​

/* OCC status register */

#define OCC_STAT_MASTER         BIT(7)

#define OCC_STAT_ACTIVE         BIT(0)

​

/* OCC extended status register */

#define OCC_EXT_STAT_DVFS_OT        BIT(7)

#define OCC_EXT_STAT_DVFS_POWER     BIT(6)

#define OCC_EXT_STAT_MEM_THROTTLE   BIT(5)

#define OCC_EXT_STAT_QUICK_DROP     BIT(4)

​

static ssize_t occ_sysfs_show(struct device *dev,

                  struct device_attribute *attr, char *buf)

{

    int rc;

    int val = 0;

    struct occ *occ = dev_get_drvdata(dev);

    struct occ_poll_response_header *header;

    struct sensor_device_attribute *sattr = to_sensor_dev_attr(attr);

​

    rc = occ_update_response(occ);

    if (rc)

        return rc;

​

    header = (struct occ_poll_response_header *)occ->resp.data;

​

    switch (sattr->index) {

    case 0:

        val = !!(header->status & OCC_STAT_MASTER);

        break;

    case 1:

        val = !!(header->status & OCC_STAT_ACTIVE);

        break;

    case 2:

        val = !!(header->ext_status & OCC_EXT_STAT_DVFS_OT);

        break;

    case 3:

        val = !!(header->ext_status & OCC_EXT_STAT_DVFS_POWER);

        break;

    case 4:

        val = !!(header->ext_status & OCC_EXT_STAT_MEM_THROTTLE);

        break;

    case 5:

        val = !!(header->ext_status & OCC_EXT_STAT_QUICK_DROP);

        break;

    case 6:

        val = header->occ_state;

        break;

    case 7:

        if (header->status & OCC_STAT_MASTER)

            val = hweight8(header->occs_present);

        else

            val = 1;