157 lines
3.3 KiB
C
157 lines
3.3 KiB
C
/*
|
|
* Copyright (c) 2006-2021, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2023-04-12 ErikChan the first version
|
|
* 2023-10-13 zmshahaha distinguish ofw and none-ofw situation
|
|
*/
|
|
|
|
#include <rtthread.h>
|
|
|
|
#define DBG_TAG "rtdm.pltaform"
|
|
#define DBG_LVL DBG_INFO
|
|
#include <rtdbg.h>
|
|
|
|
#include <drivers/platform.h>
|
|
#include <drivers/core/bus.h>
|
|
#include <drivers/core/dm.h>
|
|
|
|
static struct rt_bus platform_bus;
|
|
|
|
/**
|
|
* @brief This function create a platform device.
|
|
*
|
|
* @param name is name of the platform device.
|
|
*
|
|
* @return a new platform device.
|
|
*/
|
|
struct rt_platform_device *rt_platform_device_alloc(const char *name)
|
|
{
|
|
struct rt_platform_device *pdev = rt_calloc(1, sizeof(*pdev));
|
|
|
|
if (!pdev)
|
|
{
|
|
return RT_NULL;
|
|
}
|
|
|
|
pdev->parent.bus = &platform_bus;
|
|
pdev->name = name;
|
|
|
|
return pdev;
|
|
}
|
|
|
|
/**
|
|
* @brief This function register a rt_driver to platform bus.
|
|
*
|
|
* @return the error code, RT_EOK on successfully.
|
|
*/
|
|
rt_err_t rt_platform_driver_register(struct rt_platform_driver *pdrv)
|
|
{
|
|
RT_ASSERT(pdrv != RT_NULL);
|
|
|
|
pdrv->parent.bus = &platform_bus;
|
|
#if RT_NAME_MAX > 0
|
|
rt_strcpy(pdrv->parent.parent.name, pdrv->name);
|
|
#else
|
|
pdrv->parent.parent.name = pdrv->name;
|
|
#endif
|
|
return rt_driver_register(&pdrv->parent);
|
|
}
|
|
|
|
/**
|
|
* @brief This function register a rt_device to platform bus.
|
|
*
|
|
* @return the error code, RT_EOK on successfully.
|
|
*/
|
|
rt_err_t rt_platform_device_register(struct rt_platform_device *pdev)
|
|
{
|
|
RT_ASSERT(pdev != RT_NULL);
|
|
|
|
return rt_bus_add_device(&platform_bus, &pdev->parent);
|
|
}
|
|
|
|
static rt_bool_t platform_match(rt_driver_t drv, rt_device_t dev)
|
|
{
|
|
struct rt_platform_driver *pdrv = rt_container_of(drv, struct rt_platform_driver, parent);
|
|
struct rt_platform_device *pdev = rt_container_of(dev, struct rt_platform_device, parent);
|
|
|
|
#ifdef RT_USING_OFW
|
|
struct rt_ofw_node *np = dev->ofw_node;
|
|
|
|
/* 1、match with ofw node */
|
|
if (np)
|
|
{
|
|
pdev->id = rt_ofw_node_match(np, pdrv->ids);
|
|
|
|
if (pdev->id)
|
|
{
|
|
return RT_TRUE;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/* 2、match with name */
|
|
if (pdev->name && pdrv->name)
|
|
{
|
|
if (pdev->name == pdrv->name)
|
|
{
|
|
return RT_TRUE;
|
|
}
|
|
else
|
|
{
|
|
return !rt_strcmp(pdrv->name, pdev->name);
|
|
}
|
|
}
|
|
|
|
return RT_FALSE;
|
|
}
|
|
|
|
static rt_err_t platform_probe(rt_device_t dev)
|
|
{
|
|
rt_err_t err;
|
|
struct rt_platform_driver *pdrv = rt_container_of(dev->drv, struct rt_platform_driver, parent);
|
|
struct rt_platform_device *pdev = rt_container_of(dev, struct rt_platform_device, parent);
|
|
#ifdef RT_USING_OFW
|
|
struct rt_ofw_node *np = dev->ofw_node;
|
|
#endif
|
|
|
|
err = pdrv->probe(pdev);
|
|
|
|
if (!err)
|
|
{
|
|
#ifdef RT_USING_OFW
|
|
if (np)
|
|
{
|
|
rt_ofw_node_set_flag(np, RT_OFW_F_READLY);
|
|
}
|
|
#endif
|
|
}
|
|
else
|
|
{
|
|
if (err == -RT_ENOMEM)
|
|
{
|
|
LOG_W("System not memory in driver %s", pdrv->name);
|
|
}
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static struct rt_bus platform_bus =
|
|
{
|
|
.name = "platform",
|
|
.match = platform_match,
|
|
.probe = platform_probe,
|
|
};
|
|
|
|
static int platform_bus_init(void)
|
|
{
|
|
rt_bus_register(&platform_bus);
|
|
|
|
return 0;
|
|
}
|
|
INIT_CORE_EXPORT(platform_bus_init);
|