// 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; }