drivers/net/ethernet/aquantia/atlantic/aq_drvinfo.c

   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)
  22 static const char * const atl_temp_label[] = {
  23         "PHY Temperature",
  24         "MAC Temperature",
  25 };
  26
  27 static 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
  66 static 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
  86 static 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
 110 static 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
 116 static u32 aq_hwmon_temp_config[] = {
 117         HWMON_T_INPUT | HWMON_T_LABEL,
 118         HWMON_T_INPUT | HWMON_T_LABEL,
 119         0,
 120 };
 121
 122 static const struct hwmon_channel_info aq_hwmon_temp = {
 123         .type = hwmon_temp,
 124         .config = aq_hwmon_temp_config,
 125 };
 126
 127 static const struct hwmon_channel_info *aq_hwmon_info[] = {
 128         &aq_hwmon_temp,
 129         NULL,
 130 };
 131
 132 static const struct hwmon_chip_info aq_hwmon_chip_info = {
 133         .ops = &aq_hwmon_ops,
 134         .info = aq_hwmon_info,
 135 };
 136
 137 int 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
 157 int aq_drvinfo_init(struct net_device *ndev) { return 0; }
 158 #endif