Quelle  inspur-ipsps.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Copyright 2019 Inspur Corp.
 */

#include <linux/debugfs.h>
#include <linux/device.h>
#include <linux/fs.h>
#include <linux/i2c.h>
#include <linux/module.h>
#include <linux/pmbus.h>
#include <linux/hwmon-sysfs.h>

#include "pmbus.h"

#define IPSPS_REG_VENDOR_ID 0x99
#define IPSPS_REG_MODEL  0x9A
#define IPSPS_REG_FW_VERSION 0x9B
#define IPSPS_REG_PN  0x9C
#define IPSPS_REG_SN  0x9E
#define IPSPS_REG_HW_VERSION 0xB0
#define IPSPS_REG_MODE  0xFC

#define MODE_ACTIVE  0x55
#define MODE_STANDBY  0x0E
#define MODE_REDUNDANCY  0x00

#define MODE_ACTIVE_STRING  "active"
#define MODE_STANDBY_STRING  "standby"
#define MODE_REDUNDANCY_STRING  "redundancy"

enum ipsps_index {
 vendor,
 model,
 fw_version,
 part_number,
 serial_number,
 hw_version,
 mode,
 num_regs,
};

static const u8 ipsps_regs[num_regs] = {
 [vendor] = IPSPS_REG_VENDOR_ID,
 [model] = IPSPS_REG_MODEL,
 [fw_version] = IPSPS_REG_FW_VERSION,
 [part_number] = IPSPS_REG_PN,
 [serial_number] = IPSPS_REG_SN,
 [hw_version] = IPSPS_REG_HW_VERSION,
 [mode] = IPSPS_REG_MODE,
};

static ssize_t ipsps_string_show(struct device *dev,
     struct device_attribute *devattr,
     char *buf)
{
 u8 reg;
 int rc;
 char *p;
 char data[I2C_SMBUS_BLOCK_MAX + 1];
 struct i2c_client *client = to_i2c_client(dev->parent);
 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);

 reg = ipsps_regs[attr->index];
 rc = i2c_smbus_read_block_data(client, reg, data);
 if (rc < 0)
  return rc;

 /* filled with printable characters, ending with # */
 p = memscan(data, '#', rc);
 *p = '\0';

 return sysfs_emit(buf, "%s\n", data);
}

static ssize_t ipsps_fw_version_show(struct device *dev,
         struct device_attribute *devattr,
         char *buf)
{
 u8 reg;
 int rc;
 u8 data[I2C_SMBUS_BLOCK_MAX] = { 0 };
 struct i2c_client *client = to_i2c_client(dev->parent);
 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);

 reg = ipsps_regs[attr->index];
 rc = i2c_smbus_read_block_data(client, reg, data);
 if (rc < 0)
  return rc;

 if (rc != 6)
  return -EPROTO;

 return sysfs_emit(buf, "%u.%02u%u-%u.%02u\n",
     data[1], data[2]/* < 100 */, data[3]/*< 10*/,
     data[4], data[5]/* < 100 */);
}

static ssize_t ipsps_mode_show(struct device *dev,
          struct device_attribute *devattr, char *buf)
{
 u8 reg;
 int rc;
 struct i2c_client *client = to_i2c_client(dev->parent);
 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);

 reg = ipsps_regs[attr->index];
 rc = i2c_smbus_read_byte_data(client, reg);
 if (rc < 0)
  return rc;

 switch (rc) {
 case MODE_ACTIVE:
  return sysfs_emit(buf, "[%s] %s %s\n",
      MODE_ACTIVE_STRING,
      MODE_STANDBY_STRING, MODE_REDUNDANCY_STRING);
 case MODE_STANDBY:
  return sysfs_emit(buf, "%s [%s] %s\n",
      MODE_ACTIVE_STRING,
      MODE_STANDBY_STRING, MODE_REDUNDANCY_STRING);
 case MODE_REDUNDANCY:
  return sysfs_emit(buf, "%s %s [%s]\n",
      MODE_ACTIVE_STRING,
      MODE_STANDBY_STRING, MODE_REDUNDANCY_STRING);
 default:
  return sysfs_emit(buf, "unspecified\n");
 }
}

static ssize_t ipsps_mode_store(struct device *dev,
    struct device_attribute *devattr,
    const char *buf, size_t count)
{
 u8 reg;
 int rc;
 struct i2c_client *client = to_i2c_client(dev->parent);
 struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);

 reg = ipsps_regs[attr->index];
 if (sysfs_streq(MODE_STANDBY_STRING, buf)) {
  rc = i2c_smbus_write_byte_data(client, reg,
            MODE_STANDBY);
  if (rc < 0)
   return rc;
  return count;
 } else if (sysfs_streq(MODE_ACTIVE_STRING, buf)) {
  rc = i2c_smbus_write_byte_data(client, reg,
            MODE_ACTIVE);
  if (rc < 0)
   return rc;
  return count;
 }

 return -EINVAL;
}

static SENSOR_DEVICE_ATTR_RO(vendor, ipsps_string, vendor);
static SENSOR_DEVICE_ATTR_RO(model, ipsps_string, model);
static SENSOR_DEVICE_ATTR_RO(part_number, ipsps_string, part_number);
static SENSOR_DEVICE_ATTR_RO(serial_number, ipsps_string, serial_number);
static SENSOR_DEVICE_ATTR_RO(hw_version, ipsps_string, hw_version);
static SENSOR_DEVICE_ATTR_RO(fw_version, ipsps_fw_version, fw_version);
static SENSOR_DEVICE_ATTR_RW(mode, ipsps_mode, mode);

static struct attribute *ipsps_attrs[] = {
 &sensor_dev_attr_vendor.dev_attr.attr,
 &sensor_dev_attr_model.dev_attr.attr,
 &sensor_dev_attr_part_number.dev_attr.attr,
 &sensor_dev_attr_serial_number.dev_attr.attr,
 &sensor_dev_attr_hw_version.dev_attr.attr,
 &sensor_dev_attr_fw_version.dev_attr.attr,
 &sensor_dev_attr_mode.dev_attr.attr,
 NULL,
};

ATTRIBUTE_GROUPS(ipsps);

static struct pmbus_driver_info ipsps_info = {
 .pages = 1,
 .func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_VOUT | PMBUS_HAVE_IOUT |
  PMBUS_HAVE_IIN | PMBUS_HAVE_POUT | PMBUS_HAVE_PIN |
  PMBUS_HAVE_FAN12 | PMBUS_HAVE_TEMP | PMBUS_HAVE_TEMP2 |
  PMBUS_HAVE_TEMP3 | PMBUS_HAVE_STATUS_VOUT |
  PMBUS_HAVE_STATUS_IOUT | PMBUS_HAVE_STATUS_INPUT |
  PMBUS_HAVE_STATUS_TEMP | PMBUS_HAVE_STATUS_FAN12,
 .groups = ipsps_groups,
};

static struct pmbus_platform_data ipsps_pdata = {
 .flags = PMBUS_SKIP_STATUS_CHECK,
};

static int ipsps_probe(struct i2c_client *client)
{
 client->dev.platform_data = &ipsps_pdata;
 return pmbus_do_probe(client, &ipsps_info);
}

static const struct i2c_device_id ipsps_id[] = {
 { "ipsps1" },
 {}
};
MODULE_DEVICE_TABLE(i2c, ipsps_id);

#ifdef CONFIG_OF
static const struct of_device_id ipsps_of_match[] = {
 { .compatible = "inspur,ipsps1" },
 {}
};
MODULE_DEVICE_TABLE(of, ipsps_of_match);
#endif

static struct i2c_driver ipsps_driver = {
 .driver = {
  .name = "inspur-ipsps",
  .of_match_table = of_match_ptr(ipsps_of_match),
 },
 .probe = ipsps_probe,
 .id_table = ipsps_id,
};

module_i2c_driver(ipsps_driver);

MODULE_AUTHOR("John Wang");
MODULE_DESCRIPTION("PMBus driver for Inspur Power System power supplies");
MODULE_LICENSE("GPL");
MODULE_IMPORT_NS("PMBUS");