1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
|
/*
* Copyright (c) 2006-2022, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2022-12-06 GuEe-GUI first version
*/
#include "sdio-dw-platform.h"
#include <mmu.h>
rt_err_t sdio_dw_platform_register(struct rt_platform_device *pdev,
const struct sdio_dw_drv_data *drv_data)
{
rt_err_t err = RT_EOK;
struct rt_device *dev = &pdev->parent;
struct sdio_dw *sd = rt_calloc(1, sizeof(*sd));
if (!sd)
{
return -RT_ENOMEM;
}
sd->bus_dev = &pdev->parent;
sd->base = rt_dm_dev_iomap(dev, 0);
if (!sd->base)
{
err = -RT_EIO;
goto _fail;
}
sd->irq = rt_dm_dev_get_irq(dev, 0);
if (sd->irq < 0)
{
err = sd->irq;
goto _fail;
}
sd->parent.ofw_node = dev->ofw_node;
sd->base_phy = (rt_ubase_t)rt_kmem_v2p(sd->base);
sd->drv_data = drv_data;
pdev->parent.user_data = sd;
if ((err = sdio_dw_probe(sd)))
{
goto _fail;
}
return RT_EOK;
_fail:
if (sd->base)
{
rt_iounmap(sd->base);
}
rt_free(sd);
return err;
}
static rt_err_t sdio_dw_platform_probe(struct rt_platform_device *pdev)
{
const struct sdio_dw_drv_data *drv_data = RT_NULL;
if (pdev->parent.ofw_node)
{
drv_data = pdev->id->data;
}
return sdio_dw_platform_register(pdev, drv_data);
}
static rt_err_t sdio_dw_platform_remove(struct rt_platform_device *pdev)
{
struct sdio_dw *sd = pdev->parent.user_data;
sdio_dw_remove(sd);
rt_iounmap(sd->base);
rt_free(sd);
return RT_EOK;
}
static const struct rt_ofw_node_id sdio_dw_platform_ofw_ids[] =
{
{ .compatible = "snps,dw-mshc", },
{ .compatible = "img,pistachio-dw-mshc", },
{ /* sentinel */ }
};
static struct rt_platform_driver sdio_dw_platform_driver =
{
.name = "dw-mmc",
.ids = sdio_dw_platform_ofw_ids,
.probe = sdio_dw_platform_probe,
.remove = sdio_dw_platform_remove,
};
RT_PLATFORM_DRIVER_EXPORT(sdio_dw_platform_driver);
|
