mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-22 17:25:35 +03:00
dd109353df
This patch modifies rtcpu modules to use new ivc headers, resolves cyclic dependencies between the modules, reduces the amount of modules built by linking them together and fixes other minor issues encountered with K5.15 Change-Id: I9cf2672df08ffe6c4b8aea9ac21d6cc50a92bb4e Signed-off-by: Matti Ryttylainen <mryttylainen@nvidia.com> Reviewed-on: https://git-master.nvidia.com/r/c/linux-nv-oot/+/2787121 Reviewed-by: Laxman Dewangan <ldewangan@nvidia.com> Reviewed-by: Ankur Pawar <ankurp@nvidia.com> Reviewed-by: Semi Malinen <smalinen@nvidia.com> Reviewed-by: Pekka Pessi <ppessi@nvidia.com> Reviewed-by: Frank Chen <frankc@nvidia.com> GVS: Gerrit_Virtual_Submit <buildbot_gerritrpt@nvidia.com>
129 lines
2.7 KiB
C
129 lines
2.7 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
// Copyright (c) 2022, NVIDIA CORPORATION & AFFILIATES. All rights reserved.
|
|
|
|
#include "device-group.h"
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/types.h>
|
|
#include <linux/module.h>
|
|
|
|
struct camrtc_device_group {
|
|
struct device *dev;
|
|
char const *names_name;
|
|
int ndevices;
|
|
struct platform_device *devices[];
|
|
};
|
|
|
|
static int get_grouped_device(struct camrtc_device_group *grp,
|
|
struct device *dev, char const *name, int index)
|
|
{
|
|
struct device_node *np;
|
|
struct platform_device *pdev;
|
|
|
|
np = of_parse_phandle(dev->of_node, name, index);
|
|
if (np == NULL)
|
|
return 0;
|
|
|
|
if (!of_device_is_available(np)) {
|
|
dev_info(dev, "%s[%u] is disabled\n", name, index);
|
|
of_node_put(np);
|
|
return 0;
|
|
}
|
|
|
|
pdev = of_find_device_by_node(np);
|
|
of_node_put(np);
|
|
|
|
if (pdev == NULL) {
|
|
dev_warn(dev, "%s[%u] node has no device\n", name, index);
|
|
return 0;
|
|
}
|
|
|
|
grp->devices[index] = pdev;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void camrtc_device_group_release(struct device *dev, void *res)
|
|
{
|
|
const struct camrtc_device_group *grp = res;
|
|
int i;
|
|
|
|
put_device(grp->dev);
|
|
|
|
for (i = 0; i < grp->ndevices; i++)
|
|
platform_device_put(grp->devices[i]);
|
|
}
|
|
|
|
struct camrtc_device_group *camrtc_device_group_get(
|
|
struct device *dev,
|
|
char const *property_name,
|
|
char const *names_property_name)
|
|
{
|
|
int index, err;
|
|
struct camrtc_device_group *grp;
|
|
int ndevices;
|
|
|
|
if (!dev || !dev->of_node)
|
|
return ERR_PTR(-EINVAL);
|
|
|
|
ndevices = of_count_phandle_with_args(dev->of_node,
|
|
property_name, NULL);
|
|
if (ndevices <= 0)
|
|
return ERR_PTR(-ENOENT);
|
|
|
|
grp = devres_alloc(camrtc_device_group_release,
|
|
offsetof(struct camrtc_device_group, devices[ndevices]),
|
|
GFP_KERNEL | __GFP_ZERO);
|
|
if (!grp)
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
grp->dev = get_device(dev);
|
|
grp->ndevices = ndevices;
|
|
grp->names_name = names_property_name;
|
|
|
|
for (index = 0; index < grp->ndevices; index++) {
|
|
err = get_grouped_device(grp, dev, property_name, index);
|
|
if (err) {
|
|
devres_free(grp);
|
|
return ERR_PTR(err);
|
|
}
|
|
}
|
|
|
|
devres_add(dev, grp);
|
|
return grp;
|
|
}
|
|
EXPORT_SYMBOL(camrtc_device_group_get);
|
|
|
|
static inline struct platform_device *platform_device_get(
|
|
struct platform_device *pdev)
|
|
{
|
|
if (pdev != NULL)
|
|
get_device(&pdev->dev);
|
|
return pdev;
|
|
}
|
|
|
|
struct platform_device *camrtc_device_get_byname(
|
|
struct camrtc_device_group *grp,
|
|
const char *device_name)
|
|
{
|
|
int index;
|
|
|
|
if (grp == NULL)
|
|
return ERR_PTR(-EINVAL);
|
|
if (grp->names_name == NULL)
|
|
return ERR_PTR(-ENOENT);
|
|
|
|
index = of_property_match_string(grp->dev->of_node, grp->names_name,
|
|
device_name);
|
|
if (index < 0)
|
|
return ERR_PTR(-ENODEV);
|
|
if (index >= grp->ndevices)
|
|
return ERR_PTR(-ENODEV);
|
|
|
|
return platform_device_get(grp->devices[index]);
|
|
}
|
|
MODULE_LICENSE("GPL v2");
|