Quelle  plat.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * AMD HSMP Platform Driver
 * Copyright (c) 2024, AMD.
 * All Rights Reserved.
 *
 * This file provides platform device implementations.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <asm/amd/hsmp.h>

#include <linux/acpi.h>
#include <linux/build_bug.h>
#include <linux/device.h>
#include <linux/dev_printk.h>
#include <linux/kconfig.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/platform_device.h>
#include <linux/sysfs.h>

#include <asm/amd/node.h>

#include "hsmp.h"

#define DRIVER_NAME  "amd_hsmp"

/*
 * To access specific HSMP mailbox register, s/w writes the SMN address of HSMP mailbox
 * register into the SMN_INDEX register, and reads/writes the SMN_DATA reg.
 * Below are required SMN address for HSMP Mailbox register offsets in SMU address space
 */
#define SMN_HSMP_BASE  0x3B00000
#define SMN_HSMP_MSG_ID  0x0010534
#define SMN_HSMP_MSG_ID_F1A_M0H 0x0010934
#define SMN_HSMP_MSG_RESP 0x0010980
#define SMN_HSMP_MSG_DATA 0x00109E0

static struct hsmp_plat_device *hsmp_pdev;

static int amd_hsmp_pci_rdwr(struct hsmp_socket *sock, u32 offset,
        u32 *value, bool write)
{
 return amd_smn_hsmp_rdwr(sock->sock_ind, sock->mbinfo.base_addr + offset, value, write);
}

static ssize_t hsmp_metric_tbl_plat_read(struct file *filp, struct kobject *kobj,
      const struct bin_attribute *bin_attr, char *buf,
      loff_t off, size_t count)
{
 struct hsmp_socket *sock;
 u16 sock_ind;

 sock_ind = (uintptr_t)bin_attr->private;
 if (sock_ind >= hsmp_pdev->num_sockets)
  return -EINVAL;

 sock = &hsmp_pdev->sock[sock_ind];

 return hsmp_metric_tbl_read(sock, buf, count);
}

static umode_t hsmp_is_sock_attr_visible(struct kobject *kobj,
      const struct bin_attribute *battr, int id)
{
 u16 sock_ind;

 sock_ind = (uintptr_t)battr->private;

 if (id == 0 && sock_ind >= hsmp_pdev->num_sockets)
  return SYSFS_GROUP_INVISIBLE;

 if (hsmp_pdev->proto_ver == HSMP_PROTO_VER6)
  return battr->attr.mode;

 return 0;
}

/*
 * AMD supports maximum of 8 sockets in a system.
 * Static array of 8 + 1(for NULL) elements is created below
 * to create sysfs groups for sockets.
 * is_bin_visible function is used to show / hide the necessary groups.
 *
 * Validate the maximum number against MAX_AMD_NUM_NODES. If this changes,
 * then the attributes and groups below must be adjusted.
 */
static_assert(MAX_AMD_NUM_NODES == 8);

#define HSMP_BIN_ATTR(index, _list)     \
static const struct bin_attribute attr##index = {   \
 .attr = { .name = HSMP_METRICS_TABLE_NAME, .mode = 0444}, \
 .private = (void *)index,     \
 .read = hsmp_metric_tbl_plat_read,    \
 .size = sizeof(struct hsmp_metric_table),   \
};         \
static const struct bin_attribute _list[] = {    \
 &attr##index,       \
 NULL        \
}

HSMP_BIN_ATTR(0, *sock0_attr_list);
HSMP_BIN_ATTR(1, *sock1_attr_list);
HSMP_BIN_ATTR(2, *sock2_attr_list);
HSMP_BIN_ATTR(3, *sock3_attr_list);
HSMP_BIN_ATTR(4, *sock4_attr_list);
HSMP_BIN_ATTR(5, *sock5_attr_list);
HSMP_BIN_ATTR(6, *sock6_attr_list);
HSMP_BIN_ATTR(7, *sock7_attr_list);

#define HSMP_BIN_ATTR_GRP(index, _list, _name)   \
static const struct attribute_group sock##index##_attr_grp = { \
 .bin_attrs = _list,     \
 .is_bin_visible = hsmp_is_sock_attr_visible,  \
 .name = #_name,      \
}

HSMP_BIN_ATTR_GRP(0, sock0_attr_list, socket0);
HSMP_BIN_ATTR_GRP(1, sock1_attr_list, socket1);
HSMP_BIN_ATTR_GRP(2, sock2_attr_list, socket2);
HSMP_BIN_ATTR_GRP(3, sock3_attr_list, socket3);
HSMP_BIN_ATTR_GRP(4, sock4_attr_list, socket4);
HSMP_BIN_ATTR_GRP(5, sock5_attr_list, socket5);
HSMP_BIN_ATTR_GRP(6, sock6_attr_list, socket6);
HSMP_BIN_ATTR_GRP(7, sock7_attr_list, socket7);

static const struct attribute_group *hsmp_groups[] = {
 &sock0_attr_grp,
 &sock1_attr_grp,
 &sock2_attr_grp,
 &sock3_attr_grp,
 &sock4_attr_grp,
 &sock5_attr_grp,
 &sock6_attr_grp,
 &sock7_attr_grp,
 NULL
};

static inline bool is_f1a_m0h(void)
{
 if (boot_cpu_data.x86 == 0x1A && boot_cpu_data.x86_model <= 0x0F)
  return true;

 return false;
}

static int init_platform_device(struct device *dev)
{
 struct hsmp_socket *sock;
 int ret, i;

 for (i = 0; i < hsmp_pdev->num_sockets; i++) {
  sock = &hsmp_pdev->sock[i];
  sock->sock_ind   = i;
  sock->dev   = dev;
  sock->mbinfo.base_addr  = SMN_HSMP_BASE;
  sock->amd_hsmp_rdwr  = amd_hsmp_pci_rdwr;

  /*
 * This is a transitional change from non-ACPI to ACPI, only
 * family 0x1A, model 0x00 platform is supported for both ACPI and non-ACPI.
 */
  if (is_f1a_m0h())
   sock->mbinfo.msg_id_off = SMN_HSMP_MSG_ID_F1A_M0H;
  else
   sock->mbinfo.msg_id_off = SMN_HSMP_MSG_ID;

  sock->mbinfo.msg_resp_off = SMN_HSMP_MSG_RESP;
  sock->mbinfo.msg_arg_off = SMN_HSMP_MSG_DATA;
  sema_init(&sock->hsmp_sem, 1);

  /* Test the hsmp interface on each socket */
  ret = hsmp_test(i, 0xDEADBEEF);
  if (ret) {
   dev_err(dev, "HSMP test message failed on Fam:%x model:%x\n",
    boot_cpu_data.x86, boot_cpu_data.x86_model);
   dev_err(dev, "Is HSMP disabled in BIOS ?\n");
   return ret;
  }

  ret = hsmp_cache_proto_ver(i);
  if (ret) {
   dev_err(dev, "Failed to read HSMP protocol version\n");
   return ret;
  }

  if (hsmp_pdev->proto_ver == HSMP_PROTO_VER6) {
   ret = hsmp_get_tbl_dram_base(i);
   if (ret)
    dev_err(dev, "Failed to init metric table\n");
  }

  /* Register with hwmon interface for reporting power */
  ret = hsmp_create_sensor(dev, i);
  if (ret)
   dev_err(dev, "Failed to register HSMP sensors with hwmon\n");
 }

 return 0;
}

static int hsmp_pltdrv_probe(struct platform_device *pdev)
{
 int ret;

 hsmp_pdev->sock = devm_kcalloc(&pdev->dev, hsmp_pdev->num_sockets,
           sizeof(*hsmp_pdev->sock),
           GFP_KERNEL);
 if (!hsmp_pdev->sock)
  return -ENOMEM;

 ret = init_platform_device(&pdev->dev);
 if (ret) {
  dev_err(&pdev->dev, "Failed to init HSMP mailbox\n");
  return ret;
 }

 ret = hsmp_misc_register(&pdev->dev);
 if (ret) {
  dev_err(&pdev->dev, "Failed to register misc device\n");
  return ret;
 }

 dev_dbg(&pdev->dev, "AMD HSMP is probed successfully\n");
 return 0;
}

static void hsmp_pltdrv_remove(struct platform_device *pdev)
{
 hsmp_misc_deregister();
}

static struct platform_driver amd_hsmp_driver = {
 .probe  = hsmp_pltdrv_probe,
 .remove  = hsmp_pltdrv_remove,
 .driver  = {
  .name = DRIVER_NAME,
  .dev_groups = hsmp_groups,
 },
};

static struct platform_device *amd_hsmp_platdev;

static int hsmp_plat_dev_register(void)
{
 int ret;

 amd_hsmp_platdev = platform_device_alloc(DRIVER_NAME, PLATFORM_DEVID_NONE);
 if (!amd_hsmp_platdev)
  return -ENOMEM;

 ret = platform_device_add(amd_hsmp_platdev);
 if (ret)
  platform_device_put(amd_hsmp_platdev);

 return ret;
}

/*
 * This check is only needed for backward compatibility of previous platforms.
 * All new platforms are expected to support ACPI based probing.
 */
static bool legacy_hsmp_support(void)
{
 if (boot_cpu_data.x86_vendor != X86_VENDOR_AMD)
  return false;

 switch (boot_cpu_data.x86) {
 case 0x19:
  switch (boot_cpu_data.x86_model) {
  case 0x00 ... 0x1F:
  case 0x30 ... 0x3F:
  case 0x90 ... 0x9F:
  case 0xA0 ... 0xAF:
   return true;
  default:
   return false;
  }
 case 0x1A:
  switch (boot_cpu_data.x86_model) {
  case 0x00 ... 0x0F:
   return true;
  default:
   return false;
  }
 default:
  return false;
 }

 return false;
}

static int __init hsmp_plt_init(void)
{
 int ret = -ENODEV;

 if (acpi_dev_present(ACPI_HSMP_DEVICE_HID, NULL, -1)) {
  if (IS_ENABLED(CONFIG_AMD_HSMP_ACPI))
   pr_debug("HSMP is supported through ACPI on this platform, please use hsmp_acpi.ko\n");
  else
   pr_info("HSMP is supported through ACPI on this platform, please enable AMD_HSMP_ACPI config\n");
  return -ENODEV;
 }

 if (!legacy_hsmp_support()) {
  pr_info("HSMP interface is either disabled or not supported on family:%x model:%x\n",
   boot_cpu_data.x86, boot_cpu_data.x86_model);
  return ret;
 }

 hsmp_pdev = get_hsmp_pdev();
 if (!hsmp_pdev)
  return -ENOMEM;

 /*
 * amd_num_nodes() returns number of SMN/DF interfaces present in the system
 * if we have N SMN/DF interfaces that ideally means N sockets
 */
 hsmp_pdev->num_sockets = amd_num_nodes();
 if (hsmp_pdev->num_sockets == 0 || hsmp_pdev->num_sockets > MAX_AMD_NUM_NODES) {
  pr_err("Wrong number of sockets\n");
  return ret;
 }

 ret = platform_driver_register(&amd_hsmp_driver);
 if (ret)
  return ret;

 ret = hsmp_plat_dev_register();
 if (ret)
  platform_driver_unregister(&amd_hsmp_driver);

 return ret;
}

static void __exit hsmp_plt_exit(void)
{
 platform_device_unregister(amd_hsmp_platdev);
 platform_driver_unregister(&amd_hsmp_driver);
}

device_initcall(hsmp_plt_init);
module_exit(hsmp_plt_exit);

MODULE_IMPORT_NS("AMD_HSMP");
MODULE_DESCRIPTION("AMD HSMP Platform Interface Driver");
MODULE_VERSION(DRIVER_VERSION);
MODULE_LICENSE("GPL");