Quelle  nfp_hwmon.c   Sprache: C

// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
/* Copyright (C) 2017 Netronome Systems, Inc. */

#include <linux/kernel.h>
#include <linux/bitops.h>
#include <linux/hwmon.h>

#include "nfpcore/nfp_cpp.h"
#include "nfpcore/nfp_nsp.h"
#include "nfp_main.h"

#define NFP_TEMP_MAX  (95 * 1000)
#define NFP_TEMP_CRIT  (105 * 1000)

#define NFP_POWER_MAX  (25 * 1000 * 1000)

static int nfp_hwmon_sensor_id(enum hwmon_sensor_types type, int channel)
{
 if (type == hwmon_temp)
  return NFP_SENSOR_CHIP_TEMPERATURE;
 if (type == hwmon_power)
  return NFP_SENSOR_ASSEMBLY_POWER + channel;
 return -EINVAL;
}

static int
nfp_hwmon_read(struct device *dev, enum hwmon_sensor_types type, u32 attr,
        int channel, long *val)
{
 static const struct {
  enum hwmon_sensor_types type;
  u32 attr;
  long val;
 } const_vals[] = {
  { hwmon_temp, hwmon_temp_max,  NFP_TEMP_MAX },
  { hwmon_temp, hwmon_temp_crit, NFP_TEMP_CRIT },
  { hwmon_power, hwmon_power_max, NFP_POWER_MAX },
 };
 struct nfp_pf *pf = dev_get_drvdata(dev);
 enum nfp_nsp_sensor_id id;
 int err, i;

 for (i = 0; i < ARRAY_SIZE(const_vals); i++)
  if (const_vals[i].type == type && const_vals[i].attr == attr) {
   *val = const_vals[i].val;
   return 0;
  }

 err = nfp_hwmon_sensor_id(type, channel);
 if (err < 0)
  return err;
 id = err;

 if (!(pf->nspi->sensor_mask & BIT(id)))
  return -EOPNOTSUPP;

 if (type == hwmon_temp && attr == hwmon_temp_input)
  return nfp_hwmon_read_sensor(pf->cpp, id, val);
 if (type == hwmon_power && attr == hwmon_power_input)
  return nfp_hwmon_read_sensor(pf->cpp, id, val);

 return -EINVAL;
}

static umode_t
nfp_hwmon_is_visible(const void *data, enum hwmon_sensor_types type, u32 attr,
       int channel)
{
 if (type == hwmon_temp) {
  switch (attr) {
  case hwmon_temp_input:
  case hwmon_temp_crit:
  case hwmon_temp_max:
   return 0444;
  }
 } else if (type == hwmon_power) {
  switch (attr) {
  case hwmon_power_input:
  case hwmon_power_max:
   return 0444;
  }
 }
 return 0;
}

static const struct hwmon_channel_info * const nfp_hwmon_info[] = {
 HWMON_CHANNEL_INFO(chip, HWMON_C_REGISTER_TZ),
 HWMON_CHANNEL_INFO(temp, HWMON_T_INPUT | HWMON_T_MAX | HWMON_T_CRIT),
 HWMON_CHANNEL_INFO(power, HWMON_P_INPUT | HWMON_P_MAX,
      HWMON_P_INPUT,
      HWMON_P_INPUT),
 NULL
};

static const struct hwmon_ops nfp_hwmon_ops = {
 .is_visible = nfp_hwmon_is_visible,
 .read = nfp_hwmon_read,
};

static const struct hwmon_chip_info nfp_chip_info = {
 .ops = &nfp_hwmon_ops,
 .info = nfp_hwmon_info,
};

int nfp_hwmon_register(struct nfp_pf *pf)
{
 if (!IS_REACHABLE(CONFIG_HWMON))
  return 0;

 if (!pf->nspi) {
  nfp_warn(pf->cpp, "not registering HWMON (no NSP info)\n");
  return 0;
 }
 if (!pf->nspi->sensor_mask) {
  nfp_info(pf->cpp,
    "not registering HWMON (NSP doesn't report sensors)\n");
  return 0;
 }

 pf->hwmon_dev = hwmon_device_register_with_info(&pf->pdev->dev, "nfp",
       pf, &nfp_chip_info,
       NULL);
 return PTR_ERR_OR_ZERO(pf->hwmon_dev);
}

void nfp_hwmon_unregister(struct nfp_pf *pf)
{
 if (!IS_REACHABLE(CONFIG_HWMON) || !pf->hwmon_dev)
  return;

 hwmon_device_unregister(pf->hwmon_dev);
}