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
|
/*
* SPDX-License-Identifier: BSD-2-Clause
*
* Copyright (c) 2024 Ventana Micro Systems Inc.
*
* Authors:
* Anup Patel <apatel@ventanamicro.com>
*/
#include <libfdt.h>
#include <sbi/sbi_error.h>
#include <sbi_utils/fdt/fdt_helper.h>
#include <sbi_utils/mailbox/fdt_mailbox.h>
/* List of FDT mailbox drivers generated at compile time */
extern const struct fdt_driver *const fdt_mailbox_drivers[];
static int fdt_mbox_controller_find(const void *fdt, int nodeoff,
struct mbox_controller **out_mbox)
{
int rc;
struct mbox_controller *mbox = mbox_controller_find(nodeoff);
if (!mbox) {
/* mailbox not found so initialize matching driver */
rc = fdt_driver_init_by_offset(fdt, nodeoff, fdt_mailbox_drivers);
if (rc)
return rc;
/* Try to find mailbox controller again */
mbox = mbox_controller_find(nodeoff);
if (!mbox)
return SBI_ENOSYS;
}
if (out_mbox)
*out_mbox = mbox;
return 0;
}
int fdt_mailbox_request_chan(const void *fdt, int nodeoff, int index,
struct mbox_chan **out_chan)
{
int rc;
struct mbox_chan *chan;
struct fdt_mailbox *drv;
struct fdt_phandle_args pargs;
struct mbox_controller *mbox = NULL;
u32 chan_args[MBOX_CHAN_MAX_ARGS];
if (!fdt || (nodeoff < 0) || (index < 0) || !out_chan)
return SBI_EINVAL;
pargs.node_offset = pargs.args_count = 0;
rc = fdt_parse_phandle_with_args(fdt, nodeoff,
"mboxes", "#mbox-cells",
index, &pargs);
if (rc)
return rc;
rc = fdt_mbox_controller_find(fdt, pargs.node_offset, &mbox);
if (rc)
return rc;
drv = mbox->driver;
if (!drv || !drv->xlate)
return SBI_ENOSYS;
rc = drv->xlate(mbox, &pargs, chan_args);
if (rc)
return rc;
chan = mbox_controller_request_chan(mbox, chan_args);
if (!chan)
return SBI_ENOENT;
*out_chan = chan;
return 0;
}
int fdt_mailbox_simple_xlate(struct mbox_controller *mbox,
const struct fdt_phandle_args *pargs,
u32 *out_chan_args)
{
int i;
if (pargs->args_count < 1)
return SBI_EINVAL;
out_chan_args[0] = pargs->args[0];
for (i = 1; i < MBOX_CHAN_MAX_ARGS; i++)
out_chan_args[i] = 0;
return 0;
}
|
