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

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