324 строки
8.0 KiB
C
324 строки
8.0 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* rcar_du_of.c - Legacy DT bindings compatibility
|
|
*
|
|
* Copyright (C) 2018 Laurent Pinchart <laurent.pinchart@ideasonboard.com>
|
|
*
|
|
* Based on work from Jyri Sarha <jsarha@ti.com>
|
|
* 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);
|
|
}
|