Quelle  nfp_nsp_cmds.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/slab.h>

#include "nfp.h"
#include "nfp_nsp.h"

struct nsp_identify {
 u8 version[40];
 u8 flags;
 u8 br_primary;
 u8 br_secondary;
 u8 br_nsp;
 __le16 primary;
 __le16 secondary;
 __le16 nsp;
 u8 reserved[6];
 __le64 sensor_mask;
};

struct nfp_nsp_identify *__nfp_nsp_identify(struct nfp_nsp *nsp)
{
 struct nfp_nsp_identify *nspi = NULL;
 struct nsp_identify *ni;
 int ret;

 if (nfp_nsp_get_abi_ver_minor(nsp) < 15)
  return NULL;

 ni = kzalloc(sizeof(*ni), GFP_KERNEL);
 if (!ni)
  return NULL;

 ret = nfp_nsp_read_identify(nsp, ni, sizeof(*ni));
 if (ret < 0) {
  nfp_err(nfp_nsp_cpp(nsp), "reading bsp version failed %d\n",
   ret);
  goto exit_free;
 }

 nspi = kzalloc(sizeof(*nspi), GFP_KERNEL);
 if (!nspi)
  goto exit_free;

 memcpy(nspi->version, ni->version, sizeof(nspi->version));
 nspi->version[sizeof(nspi->version) - 1] = '\0';
 nspi->flags = ni->flags;
 nspi->br_primary = ni->br_primary;
 nspi->br_secondary = ni->br_secondary;
 nspi->br_nsp = ni->br_nsp;
 nspi->primary = le16_to_cpu(ni->primary);
 nspi->secondary = le16_to_cpu(ni->secondary);
 nspi->nsp = le16_to_cpu(ni->nsp);
 nspi->sensor_mask = le64_to_cpu(ni->sensor_mask);

exit_free:
 kfree(ni);
 return nspi;
}

struct nfp_sensors {
 __le32 chip_temp;
 __le32 assembly_power;
 __le32 assembly_12v_power;
 __le32 assembly_3v3_power;
};

int nfp_hwmon_read_sensor(struct nfp_cpp *cpp, enum nfp_nsp_sensor_id id,
     long *val)
{
 struct nfp_sensors s;
 struct nfp_nsp *nsp;
 int ret;

 nsp = nfp_nsp_open(cpp);
 if (IS_ERR(nsp))
  return PTR_ERR(nsp);

 ret = nfp_nsp_read_sensors(nsp, BIT(id), &s, sizeof(s));
 nfp_nsp_close(nsp);

 if (ret < 0)
  return ret;

 switch (id) {
 case NFP_SENSOR_CHIP_TEMPERATURE:
  *val = le32_to_cpu(s.chip_temp);
  break;
 case NFP_SENSOR_ASSEMBLY_POWER:
  *val = le32_to_cpu(s.assembly_power);
  break;
 case NFP_SENSOR_ASSEMBLY_12V_POWER:
  *val = le32_to_cpu(s.assembly_12v_power);
  break;
 case NFP_SENSOR_ASSEMBLY_3V3_POWER:
  *val = le32_to_cpu(s.assembly_3v3_power);
  break;
 default:
  return -EINVAL;
 }
 return 0;
}