1
2
3
4
5
6#include <stdio.h>
7#include <rte_byteorder.h>
8#include "nfp_cpp.h"
9#include "nfp_nsp.h"
10#include "nfp_nffw.h"
11
12struct nsp_identify {
13 uint8_t version[40];
14 uint8_t flags;
15 uint8_t br_primary;
16 uint8_t br_secondary;
17 uint8_t br_nsp;
18 uint16_t primary;
19 uint16_t secondary;
20 uint16_t nsp;
21 uint8_t reserved[6];
22 uint64_t sensor_mask;
23};
24
25struct nfp_nsp_identify *
26__nfp_nsp_identify(struct nfp_nsp *nsp)
27{
28 struct nfp_nsp_identify *nspi = NULL;
29 struct nsp_identify *ni;
30 int ret;
31
32 if (nfp_nsp_get_abi_ver_minor(nsp) < 15)
33 return NULL;
34
35 ni = malloc(sizeof(*ni));
36 if (!ni)
37 return NULL;
38
39 memset(ni, 0, sizeof(*ni));
40 ret = nfp_nsp_read_identify(nsp, ni, sizeof(*ni));
41 if (ret < 0) {
42 printf("reading bsp version failed %d\n",
43 ret);
44 goto exit_free;
45 }
46
47 nspi = malloc(sizeof(*nspi));
48 if (!nspi)
49 goto exit_free;
50
51 memset(nspi, 0, sizeof(*nspi));
52 memcpy(nspi->version, ni->version, sizeof(nspi->version));
53 nspi->version[sizeof(nspi->version) - 1] = '\0';
54 nspi->flags = ni->flags;
55 nspi->br_primary = ni->br_primary;
56 nspi->br_secondary = ni->br_secondary;
57 nspi->br_nsp = ni->br_nsp;
58 nspi->primary = rte_le_to_cpu_16(ni->primary);
59 nspi->secondary = rte_le_to_cpu_16(ni->secondary);
60 nspi->nsp = rte_le_to_cpu_16(ni->nsp);
61 nspi->sensor_mask = rte_le_to_cpu_64(ni->sensor_mask);
62
63exit_free:
64 free(ni);
65 return nspi;
66}
67
68struct nfp_sensors {
69 uint32_t chip_temp;
70 uint32_t assembly_power;
71 uint32_t assembly_12v_power;
72 uint32_t assembly_3v3_power;
73};
74
75int
76nfp_hwmon_read_sensor(struct nfp_cpp *cpp, enum nfp_nsp_sensor_id id, long *val)
77{
78 struct nfp_sensors s;
79 struct nfp_nsp *nsp;
80 int ret;
81
82 nsp = nfp_nsp_open(cpp);
83 if (!nsp)
84 return -EIO;
85
86 ret = nfp_nsp_read_sensors(nsp, BIT(id), &s, sizeof(s));
87 nfp_nsp_close(nsp);
88
89 if (ret < 0)
90 return ret;
91
92 switch (id) {
93 case NFP_SENSOR_CHIP_TEMPERATURE:
94 *val = rte_le_to_cpu_32(s.chip_temp);
95 break;
96 case NFP_SENSOR_ASSEMBLY_POWER:
97 *val = rte_le_to_cpu_32(s.assembly_power);
98 break;
99 case NFP_SENSOR_ASSEMBLY_12V_POWER:
100 *val = rte_le_to_cpu_32(s.assembly_12v_power);
101 break;
102 case NFP_SENSOR_ASSEMBLY_3V3_POWER:
103 *val = rte_le_to_cpu_32(s.assembly_3v3_power);
104 break;
105 default:
106 return -EINVAL;
107 }
108 return 0;
109}
110
