395 lines · 11.2 KB · C
RawDownload
// SPDX-License-Identifier: MIT/* * Copyright © 2026 Intel Corporation */ #include <linux/module.h>#include <linux/kernel.h>#include <linux/netdevice.h>#include <linux/xarray.h>#include <net/genetlink.h> #include <drm/drm_ras.h> #include "drm_ras_nl.h" /** * DOC: DRM RAS Node Management * * This module provides the infrastructure to manage RAS (Reliability, * Availability, and Serviceability) nodes for DRM drivers. Each * DRM driver may register one or more RAS nodes, which represent * logical components capable of reporting error counters and other * reliability metrics. * * The nodes are stored in a global xarray `drm_ras_xa` to allow * efficient lookup by ID. Nodes can be registered or unregistered * dynamically at runtime. * * A Generic Netlink family `drm_ras` exposes the below operations to * userspace: * * 1. LIST_NODES: Dump all currently registered RAS nodes. *    The user receives an array of node IDs, names, and types. * * 2. GET_ERROR_COUNTER: Get error counters of a given node. *    Userspace must provide Node ID, Error ID (Optional for specific counter). *    Returns all counters of a node if only Node ID is provided or specific *    error counters. * * 3. CLEAR_ERROR_COUNTER: Clear error counter of a given node. *    Userspace must provide Node ID, Error ID. *    Clears specific error counter of a node if supported. * * Node registration: * * - drm_ras_node_register(): Registers a new node and assigns *   it a unique ID in the xarray. * - drm_ras_node_unregister(): Removes a previously registered *   node from the xarray. * * Node type: * * - ERROR_COUNTER: *     + Currently, only error counters are supported. *     + The driver must implement the query_error_counter() callback to provide *       the name and the value of the error counter. *     + The driver must provide a error_counter_range.last value informing the *       last valid error ID. *     + The driver can provide a error_counter_range.first value informing the *       first valid error ID. *     + The error counters in the driver doesn't need to be contiguous, but the *       driver must return -ENOENT to the query_error_counter as an indication *       that the ID should be skipped and not listed in the netlink API. * * Netlink handlers: * * - drm_ras_nl_list_nodes_dumpit(): Implements the LIST_NODES *   operation, iterating over the xarray. * - drm_ras_nl_get_error_counter_dumpit(): Implements the GET_ERROR_COUNTER dumpit *   operation, fetching all counters from a specific node. * - drm_ras_nl_get_error_counter_doit(): Implements the GET_ERROR_COUNTER doit *   operation, fetching a counter value from a specific node. * - drm_ras_nl_clear_error_counter_doit(): Implements the CLEAR_ERROR_COUNTER doit *   operation, clearing a counter value from a specific node. */ static DEFINE_XARRAY_ALLOC(drm_ras_xa); /* * The netlink callback context carries dump state across multiple dumpit calls */struct drm_ras_ctx {	/* Which xarray id to restart the dump from */	unsigned long restart;}; /** * drm_ras_nl_list_nodes_dumpit() - Dump all registered RAS nodes * @skb: Netlink message buffer * @cb: Callback context for multi-part dumps * * Iterates over all registered RAS nodes in the global xarray and appends * their attributes (ID, name, type) to the given netlink message buffer. * Uses @cb->ctx to track progress in case the message buffer fills up, allowing * multi-part dump support. On buffer overflow, updates the context to resume * from the last node on the next invocation. * * Return: 0 if all nodes fit in @skb, number of bytes added to @skb if *          the buffer filled up (requires multi-part continuation), or *          a negative error code on failure. */int drm_ras_nl_list_nodes_dumpit(struct sk_buff *skb,				 struct netlink_callback *cb){	const struct genl_info *info = genl_info_dump(cb);	struct drm_ras_ctx *ctx = (void *)cb->ctx;	struct drm_ras_node *node;	struct nlattr *hdr;	unsigned long id;	int ret; 	xa_for_each_start(&drm_ras_xa, id, node, ctx->restart) {		hdr = genlmsg_iput(skb, info);		if (!hdr) {			ret = -EMSGSIZE;			break;		} 		ret = nla_put_u32(skb, DRM_RAS_A_NODE_ATTRS_NODE_ID, node->id);		if (ret) {			genlmsg_cancel(skb, hdr);			break;		} 		ret = nla_put_string(skb, DRM_RAS_A_NODE_ATTRS_DEVICE_NAME,				     node->device_name);		if (ret) {			genlmsg_cancel(skb, hdr);			break;		} 		ret = nla_put_string(skb, DRM_RAS_A_NODE_ATTRS_NODE_NAME,				     node->node_name);		if (ret) {			genlmsg_cancel(skb, hdr);			break;		} 		ret = nla_put_u32(skb, DRM_RAS_A_NODE_ATTRS_NODE_TYPE,				  node->type);		if (ret) {			genlmsg_cancel(skb, hdr);			break;		} 		genlmsg_end(skb, hdr);	} 	if (ret == -EMSGSIZE)		ctx->restart = id; 	return ret;} static int get_node_error_counter(u32 node_id, u32 error_id,				  const char **name, u32 *value){	struct drm_ras_node *node; 	node = xa_load(&drm_ras_xa, node_id);	if (!node || !node->query_error_counter)		return -ENOENT; 	if (error_id < node->error_counter_range.first ||	    error_id > node->error_counter_range.last)		return -EINVAL; 	return node->query_error_counter(node, error_id, name, value);} static int msg_reply_value(struct sk_buff *msg, u32 error_id,			   const char *error_name, u32 value){	int ret; 	ret = nla_put_u32(msg, DRM_RAS_A_ERROR_COUNTER_ATTRS_ERROR_ID, error_id);	if (ret)		return ret; 	ret = nla_put_string(msg, DRM_RAS_A_ERROR_COUNTER_ATTRS_ERROR_NAME,			     error_name);	if (ret)		return ret; 	return nla_put_u32(msg, DRM_RAS_A_ERROR_COUNTER_ATTRS_ERROR_VALUE,			   value);} static int doit_reply_value(struct genl_info *info, u32 node_id,			    u32 error_id){	struct sk_buff *msg;	struct nlattr *hdr;	const char *error_name;	u32 value;	int ret; 	msg = genlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);	if (!msg)		return -ENOMEM; 	hdr = genlmsg_iput(msg, info);	if (!hdr) {		nlmsg_free(msg);		return -EMSGSIZE;	} 	ret = get_node_error_counter(node_id, error_id,				     &error_name, &value);	if (ret)		return ret; 	ret = msg_reply_value(msg, error_id, error_name, value);	if (ret) {		genlmsg_cancel(msg, hdr);		nlmsg_free(msg);		return ret;	} 	genlmsg_end(msg, hdr); 	return genlmsg_reply(msg, info);} /** * drm_ras_nl_get_error_counter_dumpit() - Dump all Error Counters * @skb: Netlink message buffer * @cb: Callback context for multi-part dumps * * Iterates over all error counters in a given Node and appends * their attributes (ID, name, value) to the given netlink message buffer. * Uses @cb->ctx to track progress in case the message buffer fills up, allowing * multi-part dump support. On buffer overflow, updates the context to resume * from the last node on the next invocation. * * Return: 0 if all errors fit in @skb, number of bytes added to @skb if *          the buffer filled up (requires multi-part continuation), or *          a negative error code on failure. */int drm_ras_nl_get_error_counter_dumpit(struct sk_buff *skb,					struct netlink_callback *cb){	const struct genl_info *info = genl_info_dump(cb);	struct drm_ras_ctx *ctx = (void *)cb->ctx;	struct drm_ras_node *node;	struct nlattr *hdr;	const char *error_name;	u32 node_id, error_id, value;	int ret; 	if (!info->attrs || GENL_REQ_ATTR_CHECK(info, DRM_RAS_A_ERROR_COUNTER_ATTRS_NODE_ID))		return -EINVAL; 	node_id = nla_get_u32(info->attrs[DRM_RAS_A_ERROR_COUNTER_ATTRS_NODE_ID]); 	node = xa_load(&drm_ras_xa, node_id);	if (!node)		return -ENOENT; 	for (error_id = max(node->error_counter_range.first, ctx->restart);	     error_id <= node->error_counter_range.last;	     error_id++) {		ret = get_node_error_counter(node_id, error_id,					     &error_name, &value);		/*		 * For non-contiguous range, driver return -ENOENT as indication		 * to skip this ID when listing all errors.		 */		if (ret == -ENOENT)			continue;		if (ret)			return ret; 		hdr = genlmsg_iput(skb, info); 		if (!hdr) {			ret = -EMSGSIZE;			break;		} 		ret = msg_reply_value(skb, error_id, error_name, value);		if (ret) {			genlmsg_cancel(skb, hdr);			break;		} 		genlmsg_end(skb, hdr);	} 	if (ret == -EMSGSIZE)		ctx->restart = error_id; 	return ret;} /** * drm_ras_nl_get_error_counter_doit() - Query an error counter of an node * @skb: Netlink message buffer * @info: Generic Netlink info containing attributes of the request * * Extracts the node ID and error ID from the netlink attributes and * retrieves the current value of the corresponding error counter. Sends the * result back to the requesting user via the standard Genl reply. * * Return: 0 on success, or negative errno on failure. */int drm_ras_nl_get_error_counter_doit(struct sk_buff *skb,				      struct genl_info *info){	u32 node_id, error_id; 	if (!info->attrs ||	    GENL_REQ_ATTR_CHECK(info, DRM_RAS_A_ERROR_COUNTER_ATTRS_NODE_ID) ||	    GENL_REQ_ATTR_CHECK(info, DRM_RAS_A_ERROR_COUNTER_ATTRS_ERROR_ID))		return -EINVAL; 	node_id = nla_get_u32(info->attrs[DRM_RAS_A_ERROR_COUNTER_ATTRS_NODE_ID]);	error_id = nla_get_u32(info->attrs[DRM_RAS_A_ERROR_COUNTER_ATTRS_ERROR_ID]); 	return doit_reply_value(info, node_id, error_id);} /** * drm_ras_nl_clear_error_counter_doit() - Clear an error counter of a node * @skb: Netlink message buffer * @info: Generic Netlink info containing attributes of the request * * Extracts the node ID and error ID from the netlink attributes and * clears the current value. * * Return: 0 on success, or negative errno on failure. */int drm_ras_nl_clear_error_counter_doit(struct sk_buff *skb,					struct genl_info *info){	struct drm_ras_node *node;	u32 node_id, error_id; 	if (!info->attrs ||	    GENL_REQ_ATTR_CHECK(info, DRM_RAS_A_ERROR_COUNTER_ATTRS_NODE_ID) ||	    GENL_REQ_ATTR_CHECK(info, DRM_RAS_A_ERROR_COUNTER_ATTRS_ERROR_ID))		return -EINVAL; 	node_id = nla_get_u32(info->attrs[DRM_RAS_A_ERROR_COUNTER_ATTRS_NODE_ID]);	error_id = nla_get_u32(info->attrs[DRM_RAS_A_ERROR_COUNTER_ATTRS_ERROR_ID]); 	node = xa_load(&drm_ras_xa, node_id);	if (!node || !node->clear_error_counter)		return -ENOENT; 	if (error_id < node->error_counter_range.first ||	    error_id > node->error_counter_range.last)		return -EINVAL; 	return node->clear_error_counter(node, error_id);} /** * drm_ras_node_register() - Register a new RAS node * @node: Node structure to register * * Adds the given RAS node to the global node xarray and assigns it * a unique ID. Both @node->name and @node->type must be valid. * * Return: 0 on success, or negative errno on failure: */int drm_ras_node_register(struct drm_ras_node *node){	if (!node->device_name || !node->node_name)		return -EINVAL; 	/* Currently, only Error Counter Endpoints are supported */	if (node->type != DRM_RAS_NODE_TYPE_ERROR_COUNTER)		return -EINVAL; 	/* Mandatory entries for Error Counter Node */	if (node->type == DRM_RAS_NODE_TYPE_ERROR_COUNTER &&	    (!node->error_counter_range.last || !node->query_error_counter))		return -EINVAL; 	return xa_alloc(&drm_ras_xa, &node->id, node, xa_limit_32b, GFP_KERNEL);}EXPORT_SYMBOL(drm_ras_node_register); /** * drm_ras_node_unregister() - Unregister a previously registered node * @node: Node structure to unregister * * Removes the given node from the global node xarray using its ID. */void drm_ras_node_unregister(struct drm_ras_node *node){	xa_erase(&drm_ras_xa, node->id);}EXPORT_SYMBOL(drm_ras_node_unregister);