cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

aq_drvinfo.c (3368B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/* Atlantic Network Driver
      3 *
      4 * Copyright (C) 2014-2019 aQuantia Corporation
      5 * Copyright (C) 2019-2020 Marvell International Ltd.
      6 */
      7
      8/* File aq_drvinfo.c: Definition of common code for firmware info in sys.*/
      9
     10#include <linux/init.h>
     11#include <linux/kobject.h>
     12#include <linux/module.h>
     13#include <linux/stat.h>
     14#include <linux/string.h>
     15#include <linux/hwmon.h>
     16#include <linux/uaccess.h>
     17
     18#include "aq_drvinfo.h"
     19#include "aq_nic.h"
     20
     21#if IS_REACHABLE(CONFIG_HWMON)
     22static const char * const atl_temp_label[] = {
     23	"PHY Temperature",
     24	"MAC Temperature",
     25};
     26
     27static int aq_hwmon_read(struct device *dev, enum hwmon_sensor_types type,
     28			 u32 attr, int channel, long *value)
     29{
     30	struct aq_nic_s *aq_nic = dev_get_drvdata(dev);
     31	int err = 0;
     32	int temp;
     33
     34	if (!aq_nic)
     35		return -EIO;
     36
     37	if (type != hwmon_temp || attr != hwmon_temp_input)
     38		return -EOPNOTSUPP;
     39
     40	switch (channel) {
     41	case 0:
     42		if (!aq_nic->aq_fw_ops->get_phy_temp)
     43			return -EOPNOTSUPP;
     44
     45		err = aq_nic->aq_fw_ops->get_phy_temp(aq_nic->aq_hw, &temp);
     46		*value = temp;
     47		break;
     48	case 1:
     49		if (!aq_nic->aq_fw_ops->get_mac_temp &&
     50		    !aq_nic->aq_hw_ops->hw_get_mac_temp)
     51			return -EOPNOTSUPP;
     52
     53		if (aq_nic->aq_fw_ops->get_mac_temp)
     54			err = aq_nic->aq_fw_ops->get_mac_temp(aq_nic->aq_hw, &temp);
     55		else
     56			err = aq_nic->aq_hw_ops->hw_get_mac_temp(aq_nic->aq_hw, &temp);
     57		*value = temp;
     58		break;
     59	default:
     60		return -EOPNOTSUPP;
     61	}
     62
     63	return err;
     64}
     65
     66static int aq_hwmon_read_string(struct device *dev,
     67				enum hwmon_sensor_types type,
     68				u32 attr, int channel, const char **str)
     69{
     70	struct aq_nic_s *aq_nic = dev_get_drvdata(dev);
     71
     72	if (!aq_nic)
     73		return -EIO;
     74
     75	if (type != hwmon_temp || attr != hwmon_temp_label)
     76		return -EOPNOTSUPP;
     77
     78	if (channel < ARRAY_SIZE(atl_temp_label))
     79		*str = atl_temp_label[channel];
     80	else
     81		return -EOPNOTSUPP;
     82
     83	return 0;
     84}
     85
     86static umode_t aq_hwmon_is_visible(const void *data,
     87				   enum hwmon_sensor_types type,
     88				   u32 attr, int channel)
     89{
     90	const struct aq_nic_s *nic = data;
     91
     92	if (type != hwmon_temp)
     93		return 0;
     94
     95	if (channel == 0 && !nic->aq_fw_ops->get_phy_temp)
     96		return 0;
     97	else if (channel == 1 && !nic->aq_fw_ops->get_mac_temp &&
     98		 !nic->aq_hw_ops->hw_get_mac_temp)
     99		return 0;
    100
    101	switch (attr) {
    102	case hwmon_temp_input:
    103	case hwmon_temp_label:
    104		return 0444;
    105	default:
    106		return 0;
    107	}
    108}
    109
    110static const struct hwmon_ops aq_hwmon_ops = {
    111	.is_visible = aq_hwmon_is_visible,
    112	.read = aq_hwmon_read,
    113	.read_string = aq_hwmon_read_string,
    114};
    115
    116static u32 aq_hwmon_temp_config[] = {
    117	HWMON_T_INPUT | HWMON_T_LABEL,
    118	HWMON_T_INPUT | HWMON_T_LABEL,
    119	0,
    120};
    121
    122static const struct hwmon_channel_info aq_hwmon_temp = {
    123	.type = hwmon_temp,
    124	.config = aq_hwmon_temp_config,
    125};
    126
    127static const struct hwmon_channel_info *aq_hwmon_info[] = {
    128	&aq_hwmon_temp,
    129	NULL,
    130};
    131
    132static const struct hwmon_chip_info aq_hwmon_chip_info = {
    133	.ops = &aq_hwmon_ops,
    134	.info = aq_hwmon_info,
    135};
    136
    137int aq_drvinfo_init(struct net_device *ndev)
    138{
    139	struct aq_nic_s *aq_nic = netdev_priv(ndev);
    140	struct device *dev = &aq_nic->pdev->dev;
    141	struct device *hwmon_dev;
    142	int err = 0;
    143
    144	hwmon_dev = devm_hwmon_device_register_with_info(dev,
    145							 ndev->name,
    146							 aq_nic,
    147							 &aq_hwmon_chip_info,
    148							 NULL);
    149
    150	if (IS_ERR(hwmon_dev))
    151		err = PTR_ERR(hwmon_dev);
    152
    153	return err;
    154}
    155
    156#else
    157int aq_drvinfo_init(struct net_device *ndev) { return 0; }
    158#endif