drivers/gpu/drm/rcar-du/rcar_du_of.c - kernel/common - Git at Google

 // SPDX-License-Identifier: GPL-2.0
 /*
  * rcar_du_of.c - Legacy DT bindings compatibility
  *
  * Copyright (C) 2018 Laurent Pinchart <[email protected]>
  *
  * Based on work from Jyri Sarha <[email protected]>
  * Copyright (C) 2015 Texas Instruments
  */

 #include <linux/init.h>
 #include <linux/kernel.h>
 #include <linux/of.h>
 #include <linux/of_address.h>
 #include <linux/of_fdt.h>
 #include <linux/of_graph.h>
 #include <linux/slab.h>

 #include "rcar_du_crtc.h"
 #include "rcar_du_drv.h"
 #include "rcar_du_of.h"

 /* -----------------------------------------------------------------------------
  * Generic Overlay Handling
  */

 struct rcar_du_of_overlay {
 	const char *compatible;
 	void *begin;
 	void *end;
 };

 #define RCAR_DU_OF_DTB(type, soc)					\
 	extern char __dtb_rcar_du_of_##type##_##soc##_begin[];		\
 	extern char __dtb_rcar_du_of_##type##_##soc##_end[]

 #define RCAR_DU_OF_OVERLAY(type, soc)					\
 	{								\
 		.compatible = "renesas,du-" #soc,			\
 		.begin = __dtb_rcar_du_of_##type##_##soc##_begin,	\
 		.end = __dtb_rcar_du_of_##type##_##soc##_end,		\
 	}

 static int __init rcar_du_of_apply_overlay(const struct rcar_du_of_overlay *dtbs,
 					   const char *compatible)
 {
 	const struct rcar_du_of_overlay *dtb = NULL;
 	unsigned int i;
 	int ovcs_id;

 	for (i = 0; dtbs[i].compatible; ++i) {
 		if (!strcmp(dtbs[i].compatible, compatible)) {
 			dtb = &dtbs[i];
 			break;
 		}
 	}

 	if (!dtb)
 		return -ENODEV;

 	ovcs_id = 0;
 	return of_overlay_fdt_apply(dtb->begin, dtb->end - dtb->begin,
 				    &ovcs_id);
 }

 static int __init rcar_du_of_add_property(struct of_changeset *ocs,
 					  struct device_node *np,
 					  const char *name, const void *value,
 					  int length)
 {
 	struct property *prop;
 	int ret = -ENOMEM;

 	prop = kzalloc(sizeof(*prop), GFP_KERNEL);
 	if (!prop)
 		return -ENOMEM;

 	prop->name = kstrdup(name, GFP_KERNEL);
 	if (!prop->name)
 		goto out_err;

 	prop->value = kmemdup(value, length, GFP_KERNEL);
 	if (!prop->value)
 		goto out_err;

 	of_property_set_flag(prop, OF_DYNAMIC);

 	prop->length = length;

 	ret = of_changeset_add_property(ocs, np, prop);
 	if (!ret)
 		return 0;

 out_err:
 	kfree(prop->value);
 	kfree(prop->name);
 	kfree(prop);
 	return ret;
 }

 /* -----------------------------------------------------------------------------
  * LVDS Overlays
  */

 RCAR_DU_OF_DTB(lvds, r8a7790);
 RCAR_DU_OF_DTB(lvds, r8a7791);
 RCAR_DU_OF_DTB(lvds, r8a7793);
 RCAR_DU_OF_DTB(lvds, r8a7795);
 RCAR_DU_OF_DTB(lvds, r8a7796);

 static const struct rcar_du_of_overlay rcar_du_lvds_overlays[] __initconst = {
 	RCAR_DU_OF_OVERLAY(lvds, r8a7790),
 	RCAR_DU_OF_OVERLAY(lvds, r8a7791),
 	RCAR_DU_OF_OVERLAY(lvds, r8a7793),
 	RCAR_DU_OF_OVERLAY(lvds, r8a7795),
 	RCAR_DU_OF_OVERLAY(lvds, r8a7796),
 	{ /* Sentinel */ },
 };

 static struct of_changeset rcar_du_lvds_changeset;

 static void __init rcar_du_of_lvds_patch_one(struct device_node *lvds,
 					     const struct of_phandle_args *clk,
 					     struct device_node *local,
 					     struct device_node *remote)
 {
 	unsigned int psize;
 	unsigned int i;
 	__be32 value[4];
 	int ret;

 	/*
 	 * Set the LVDS clocks property. This can't be performed by the overlay
 	 * as the structure of the clock specifier has changed over time, and we
 	 * don't know at compile time which binding version the system we will
 	 * run on uses.
 	 */
 	if (clk->args_count >= ARRAY_SIZE(value) - 1)
 		return;

 	of_changeset_init(&rcar_du_lvds_changeset);

 	value[0] = cpu_to_be32(clk->np->phandle);
 	for (i = 0; i < clk->args_count; ++i)
 		value[i + 1] = cpu_to_be32(clk->args[i]);

 	psize = (clk->args_count + 1) * 4;
 	ret = rcar_du_of_add_property(&rcar_du_lvds_changeset, lvds,
 				      "clocks", value, psize);
 	if (ret < 0)
 		goto done;

 	/*
 	 * Insert the node in the OF graph: patch the LVDS ports remote-endpoint
 	 * properties to point to the endpoints of the sibling nodes in the
 	 * graph. This can't be performed by the overlay: on the input side the
 	 * overlay would contain a phandle for the DU LVDS output port that
 	 * would clash with the system DT, and on the output side the connection
 	 * is board-specific.
 	 */
 	value[0] = cpu_to_be32(local->phandle);
 	value[1] = cpu_to_be32(remote->phandle);

 	for (i = 0; i < 2; ++i) {
 		struct device_node *endpoint;

 		endpoint = of_graph_get_endpoint_by_regs(lvds, i, 0);
 		if (!endpoint) {
 			ret = -EINVAL;
 			goto done;
 		}

 		ret = rcar_du_of_add_property(&rcar_du_lvds_changeset,
 					      endpoint, "remote-endpoint",
 					      &value[i], sizeof(value[i]));
 		of_node_put(endpoint);
 		if (ret < 0)
 			goto done;
 	}

 	ret = of_changeset_apply(&rcar_du_lvds_changeset);

 done:
 	if (ret < 0)
 		of_changeset_destroy(&rcar_du_lvds_changeset);
 }

 struct lvds_of_data {
 	struct resource res;
 	struct of_phandle_args clkspec;
 	struct device_node *local;
 	struct device_node *remote;
 };

 static void __init rcar_du_of_lvds_patch(const struct of_device_id *of_ids)
 {
 	const struct rcar_du_device_info *info;
 	const struct of_device_id *match;
 	struct lvds_of_data lvds_data[2] = { };
 	struct device_node *lvds_node;
 	struct device_node *soc_node;
 	struct device_node *du_node;
 	char compatible[22];
 	const char *soc_name;
 	unsigned int i;
 	int ret;

 	/* Get the DU node and exit if not present or disabled. */
 	du_node = of_find_matching_node_and_match(NULL, of_ids, &match);
 	if (!du_node || !of_device_is_available(du_node)) {
 		of_node_put(du_node);
 		return;
 	}

 	info = match->data;
 	soc_node = of_get_parent(du_node);

 	if (WARN_ON(info->num_lvds > ARRAY_SIZE(lvds_data)))
 		goto done;

 	/*
 	 * Skip if the LVDS nodes already exists.
 	 *
 	 * The nodes are searched based on the compatible string, which we
 	 * construct from the SoC name found in the DU compatible string. As a
 	 * match has been found we know the compatible string matches the
 	 * expected format and can thus skip some of the string manipulation
 	 * normal safety checks.
 	 */
 	soc_name = strchr(match->compatible, '-') + 1;
 	sprintf(compatible, "renesas,%s-lvds", soc_name);
 	lvds_node = of_find_compatible_node(NULL, NULL, compatible);
 	if (lvds_node) {
 		of_node_put(lvds_node);
 		return;
 	}

 	/*
 	 * Parse the DU node and store the register specifier, the clock
 	 * specifier and the local and remote endpoint of the LVDS link for
 	 * later use.
 	 */
 	for (i = 0; i < info->num_lvds; ++i) {
 		struct lvds_of_data *lvds = &lvds_data[i];
 		unsigned int port;
 		char name[7];
 		int index;

 		sprintf(name, "lvds.%u", i);
 		index = of_property_match_string(du_node, "clock-names", name);
 		if (index < 0)
 			continue;

 		ret = of_parse_phandle_with_args(du_node, "clocks",
 						 "#clock-cells", index,
 						 &lvds->clkspec);
 		if (ret < 0)
 			continue;

 		port = info->routes[RCAR_DU_OUTPUT_LVDS0 + i].port;

 		lvds->local = of_graph_get_endpoint_by_regs(du_node, port, 0);
 		if (!lvds->local)
 			continue;

 		lvds->remote = of_graph_get_remote_endpoint(lvds->local);
 		if (!lvds->remote)
 			continue;

 		index = of_property_match_string(du_node, "reg-names", name);
 		if (index < 0)
 			continue;

 		of_address_to_resource(du_node, index, &lvds->res);
 	}

 	/* Parse and apply the overlay. This will resolve phandles. */
 	ret = rcar_du_of_apply_overlay(rcar_du_lvds_overlays,
 				       match->compatible);
 	if (ret < 0)
 		goto done;

 	/* Patch the newly created LVDS encoder nodes. */
 	for_each_child_of_node(soc_node, lvds_node) {
 		struct resource res;

 		if (!of_device_is_compatible(lvds_node, compatible))
 			continue;

 		/* Locate the lvds_data entry based on the resource start. */
 		ret = of_address_to_resource(lvds_node, 0, &res);
 		if (ret < 0)
 			continue;

 		for (i = 0; i < ARRAY_SIZE(lvds_data); ++i) {
 			if (lvds_data[i].res.start == res.start)
 				break;
 		}

 		if (i == ARRAY_SIZE(lvds_data))
 			continue;

 		/* Patch the LVDS encoder. */
 		rcar_du_of_lvds_patch_one(lvds_node, &lvds_data[i].clkspec,
 					  lvds_data[i].local,
 					  lvds_data[i].remote);
 	}

 done:
 	for (i = 0; i < info->num_lvds; ++i) {
 		of_node_put(lvds_data[i].clkspec.np);
 		of_node_put(lvds_data[i].local);
 		of_node_put(lvds_data[i].remote);
 	}

 	of_node_put(soc_node);
 	of_node_put(du_node);
 }

 void __init rcar_du_of_init(const struct of_device_id *of_ids)
 {
 	rcar_du_of_lvds_patch(of_ids);
 }
	// SPDX-License-Identifier: GPL-2.0
	/*
	* rcar_du_of.c - Legacy DT bindings compatibility
	*
	* Copyright (C) 2018 Laurent Pinchart <[email protected]>
	*
	* Based on work from Jyri Sarha <[email protected]>
	* Copyright (C) 2015 Texas Instruments
	*/

	#include <linux/init.h>
	#include <linux/kernel.h>
	#include <linux/of.h>
	#include <linux/of_address.h>
	#include <linux/of_fdt.h>
	#include <linux/of_graph.h>
	#include <linux/slab.h>

	#include "rcar_du_crtc.h"
	#include "rcar_du_drv.h"
	#include "rcar_du_of.h"

	/* -----------------------------------------------------------------------------
	* Generic Overlay Handling
	*/

	struct rcar_du_of_overlay {
	const char *compatible;
	void *begin;
	void *end;
	};

	#define RCAR_DU_OF_DTB(type, soc) \
	extern char __dtb_rcar_du_of_##type##_##soc##_begin[]; \
	extern char __dtb_rcar_du_of_##type##_##soc##_end[]

	#define RCAR_DU_OF_OVERLAY(type, soc) \
	{ \
	.compatible = "renesas,du-" #soc, \
	.begin = __dtb_rcar_du_of_##type##_##soc##_begin, \
	.end = __dtb_rcar_du_of_##type##_##soc##_end, \
	}

	static int __init rcar_du_of_apply_overlay(const struct rcar_du_of_overlay *dtbs,
	const char *compatible)
	{
	const struct rcar_du_of_overlay *dtb = NULL;
	unsigned int i;
	int ovcs_id;

	for (i = 0; dtbs[i].compatible; ++i) {
	if (!strcmp(dtbs[i].compatible, compatible)) {
	dtb = &dtbs[i];
	break;
	}
	}

	if (!dtb)
	return -ENODEV;

	ovcs_id = 0;
	return of_overlay_fdt_apply(dtb->begin, dtb->end - dtb->begin,
	&ovcs_id);
	}

	static int __init rcar_du_of_add_property(struct of_changeset *ocs,
	struct device_node *np,
	const char name, const void value,
	int length)
	{
	struct property *prop;
	int ret = -ENOMEM;

	prop = kzalloc(sizeof(*prop), GFP_KERNEL);
	if (!prop)
	return -ENOMEM;

	prop->name = kstrdup(name, GFP_KERNEL);
	if (!prop->name)
	goto out_err;

	prop->value = kmemdup(value, length, GFP_KERNEL);
	if (!prop->value)
	goto out_err;

	of_property_set_flag(prop, OF_DYNAMIC);

	prop->length = length;

	ret = of_changeset_add_property(ocs, np, prop);
	if (!ret)
	return 0;

	out_err:
	kfree(prop->value);
	kfree(prop->name);
	kfree(prop);
	return ret;
	}

	/* -----------------------------------------------------------------------------
	* LVDS Overlays
	*/

	RCAR_DU_OF_DTB(lvds, r8a7790);
	RCAR_DU_OF_DTB(lvds, r8a7791);
	RCAR_DU_OF_DTB(lvds, r8a7793);
	RCAR_DU_OF_DTB(lvds, r8a7795);
	RCAR_DU_OF_DTB(lvds, r8a7796);

	static const struct rcar_du_of_overlay rcar_du_lvds_overlays[] __initconst = {
	RCAR_DU_OF_OVERLAY(lvds, r8a7790),
	RCAR_DU_OF_OVERLAY(lvds, r8a7791),
	RCAR_DU_OF_OVERLAY(lvds, r8a7793),
	RCAR_DU_OF_OVERLAY(lvds, r8a7795),
	RCAR_DU_OF_OVERLAY(lvds, r8a7796),
	{ /* Sentinel */ },
	};

	static struct of_changeset rcar_du_lvds_changeset;

	static void __init rcar_du_of_lvds_patch_one(struct device_node *lvds,
	const struct of_phandle_args *clk,
	struct device_node *local,
	struct device_node *remote)
	{
	unsigned int psize;
	unsigned int i;
	__be32 value[4];
	int ret;

	/*
	* Set the LVDS clocks property. This can't be performed by the overlay
	* as the structure of the clock specifier has changed over time, and we
	* don't know at compile time which binding version the system we will
	* run on uses.
	*/
	if (clk->args_count >= ARRAY_SIZE(value) - 1)
	return;

	of_changeset_init(&rcar_du_lvds_changeset);

	value[0] = cpu_to_be32(clk->np->phandle);
	for (i = 0; i < clk->args_count; ++i)
	value[i + 1] = cpu_to_be32(clk->args[i]);

	psize = (clk->args_count + 1) * 4;
	ret = rcar_du_of_add_property(&rcar_du_lvds_changeset, lvds,
	"clocks", value, psize);
	if (ret < 0)
	goto done;

	/*
	* Insert the node in the OF graph: patch the LVDS ports remote-endpoint
	* properties to point to the endpoints of the sibling nodes in the
	* graph. This can't be performed by the overlay: on the input side the
	* overlay would contain a phandle for the DU LVDS output port that
	* would clash with the system DT, and on the output side the connection
	* is board-specific.
	*/
	value[0] = cpu_to_be32(local->phandle);
	value[1] = cpu_to_be32(remote->phandle);

	for (i = 0; i < 2; ++i) {
	struct device_node *endpoint;

	endpoint = of_graph_get_endpoint_by_regs(lvds, i, 0);
	if (!endpoint) {
	ret = -EINVAL;
	goto done;
	}

	ret = rcar_du_of_add_property(&rcar_du_lvds_changeset,
	endpoint, "remote-endpoint",
	&value[i], sizeof(value[i]));
	of_node_put(endpoint);
	if (ret < 0)
	goto done;
	}

	ret = of_changeset_apply(&rcar_du_lvds_changeset);

	done:
	if (ret < 0)
	of_changeset_destroy(&rcar_du_lvds_changeset);
	}

	struct lvds_of_data {
	struct resource res;
	struct of_phandle_args clkspec;
	struct device_node *local;
	struct device_node *remote;
	};

	static void __init rcar_du_of_lvds_patch(const struct of_device_id *of_ids)
	{
	const struct rcar_du_device_info *info;
	const struct of_device_id *match;
	struct lvds_of_data lvds_data[2] = { };
	struct device_node *lvds_node;
	struct device_node *soc_node;
	struct device_node *du_node;
	char compatible[22];
	const char *soc_name;
	unsigned int i;
	int ret;

	/* Get the DU node and exit if not present or disabled. */
	du_node = of_find_matching_node_and_match(NULL, of_ids, &match);
	if (!du_node \|\| !of_device_is_available(du_node)) {
	of_node_put(du_node);
	return;
	}

	info = match->data;
	soc_node = of_get_parent(du_node);

	if (WARN_ON(info->num_lvds > ARRAY_SIZE(lvds_data)))
	goto done;

	/*
	* Skip if the LVDS nodes already exists.
	*
	* The nodes are searched based on the compatible string, which we
	* construct from the SoC name found in the DU compatible string. As a
	* match has been found we know the compatible string matches the
	* expected format and can thus skip some of the string manipulation
	* normal safety checks.
	*/
	soc_name = strchr(match->compatible, '-') + 1;
	sprintf(compatible, "renesas,%s-lvds", soc_name);
	lvds_node = of_find_compatible_node(NULL, NULL, compatible);
	if (lvds_node) {
	of_node_put(lvds_node);
	return;
	}

	/*
	* Parse the DU node and store the register specifier, the clock
	* specifier and the local and remote endpoint of the LVDS link for
	* later use.
	*/
	for (i = 0; i < info->num_lvds; ++i) {
	struct lvds_of_data *lvds = &lvds_data[i];
	unsigned int port;
	char name[7];
	int index;

	sprintf(name, "lvds.%u", i);
	index = of_property_match_string(du_node, "clock-names", name);
	if (index < 0)
	continue;

	ret = of_parse_phandle_with_args(du_node, "clocks",
	"#clock-cells", index,
	&lvds->clkspec);
	if (ret < 0)
	continue;

	port = info->routes[RCAR_DU_OUTPUT_LVDS0 + i].port;

	lvds->local = of_graph_get_endpoint_by_regs(du_node, port, 0);
	if (!lvds->local)
	continue;

	lvds->remote = of_graph_get_remote_endpoint(lvds->local);
	if (!lvds->remote)
	continue;

	index = of_property_match_string(du_node, "reg-names", name);
	if (index < 0)
	continue;

	of_address_to_resource(du_node, index, &lvds->res);
	}

	/* Parse and apply the overlay. This will resolve phandles. */
	ret = rcar_du_of_apply_overlay(rcar_du_lvds_overlays,
	match->compatible);
	if (ret < 0)
	goto done;

	/* Patch the newly created LVDS encoder nodes. */
	for_each_child_of_node(soc_node, lvds_node) {
	struct resource res;

	if (!of_device_is_compatible(lvds_node, compatible))
	continue;

	/* Locate the lvds_data entry based on the resource start. */
	ret = of_address_to_resource(lvds_node, 0, &res);
	if (ret < 0)
	continue;

	for (i = 0; i < ARRAY_SIZE(lvds_data); ++i) {
	if (lvds_data[i].res.start == res.start)
	break;
	}

	if (i == ARRAY_SIZE(lvds_data))
	continue;

	/* Patch the LVDS encoder. */
	rcar_du_of_lvds_patch_one(lvds_node, &lvds_data[i].clkspec,
	lvds_data[i].local,
	lvds_data[i].remote);
	}

	done:
	for (i = 0; i < info->num_lvds; ++i) {
	of_node_put(lvds_data[i].clkspec.np);
	of_node_put(lvds_data[i].local);
	of_node_put(lvds_data[i].remote);
	}

	of_node_put(soc_node);
	of_node_put(du_node);
	}

	void __init rcar_du_of_init(const struct of_device_id *of_ids)
	{
	rcar_du_of_lvds_patch(of_ids);
	}