1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (c) 2016, NVIDIA CORPORATION.
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <common.h>
8*4882a593Smuzhiyun #include <dm.h>
9*4882a593Smuzhiyun #include <mailbox-uclass.h>
10*4882a593Smuzhiyun #include <asm/io.h>
11*4882a593Smuzhiyun #include <asm/mbox.h>
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun #define SANDBOX_MBOX_CHANNELS 2
14*4882a593Smuzhiyun
15*4882a593Smuzhiyun struct sandbox_mbox_chan {
16*4882a593Smuzhiyun bool rx_msg_valid;
17*4882a593Smuzhiyun uint32_t rx_msg;
18*4882a593Smuzhiyun };
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun struct sandbox_mbox {
21*4882a593Smuzhiyun struct sandbox_mbox_chan chans[SANDBOX_MBOX_CHANNELS];
22*4882a593Smuzhiyun };
23*4882a593Smuzhiyun
sandbox_mbox_request(struct mbox_chan * chan)24*4882a593Smuzhiyun static int sandbox_mbox_request(struct mbox_chan *chan)
25*4882a593Smuzhiyun {
26*4882a593Smuzhiyun debug("%s(chan=%p)\n", __func__, chan);
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun if (chan->id >= SANDBOX_MBOX_CHANNELS)
29*4882a593Smuzhiyun return -EINVAL;
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun return 0;
32*4882a593Smuzhiyun }
33*4882a593Smuzhiyun
sandbox_mbox_free(struct mbox_chan * chan)34*4882a593Smuzhiyun static int sandbox_mbox_free(struct mbox_chan *chan)
35*4882a593Smuzhiyun {
36*4882a593Smuzhiyun debug("%s(chan=%p)\n", __func__, chan);
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun return 0;
39*4882a593Smuzhiyun }
40*4882a593Smuzhiyun
sandbox_mbox_send(struct mbox_chan * chan,const void * data)41*4882a593Smuzhiyun static int sandbox_mbox_send(struct mbox_chan *chan, const void *data)
42*4882a593Smuzhiyun {
43*4882a593Smuzhiyun struct sandbox_mbox *sbm = dev_get_priv(chan->dev);
44*4882a593Smuzhiyun const uint32_t *pmsg = data;
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun debug("%s(chan=%p, data=%p)\n", __func__, chan, data);
47*4882a593Smuzhiyun
48*4882a593Smuzhiyun sbm->chans[chan->id].rx_msg = *pmsg ^ SANDBOX_MBOX_PING_XOR;
49*4882a593Smuzhiyun sbm->chans[chan->id].rx_msg_valid = true;
50*4882a593Smuzhiyun
51*4882a593Smuzhiyun return 0;
52*4882a593Smuzhiyun }
53*4882a593Smuzhiyun
sandbox_mbox_recv(struct mbox_chan * chan,void * data)54*4882a593Smuzhiyun static int sandbox_mbox_recv(struct mbox_chan *chan, void *data)
55*4882a593Smuzhiyun {
56*4882a593Smuzhiyun struct sandbox_mbox *sbm = dev_get_priv(chan->dev);
57*4882a593Smuzhiyun uint32_t *pmsg = data;
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun debug("%s(chan=%p, data=%p)\n", __func__, chan, data);
60*4882a593Smuzhiyun
61*4882a593Smuzhiyun if (!sbm->chans[chan->id].rx_msg_valid)
62*4882a593Smuzhiyun return -ENODATA;
63*4882a593Smuzhiyun
64*4882a593Smuzhiyun *pmsg = sbm->chans[chan->id].rx_msg;
65*4882a593Smuzhiyun sbm->chans[chan->id].rx_msg_valid = false;
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun return 0;
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun
sandbox_mbox_bind(struct udevice * dev)70*4882a593Smuzhiyun static int sandbox_mbox_bind(struct udevice *dev)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun debug("%s(dev=%p)\n", __func__, dev);
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun return 0;
75*4882a593Smuzhiyun }
76*4882a593Smuzhiyun
sandbox_mbox_probe(struct udevice * dev)77*4882a593Smuzhiyun static int sandbox_mbox_probe(struct udevice *dev)
78*4882a593Smuzhiyun {
79*4882a593Smuzhiyun debug("%s(dev=%p)\n", __func__, dev);
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun return 0;
82*4882a593Smuzhiyun }
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun static const struct udevice_id sandbox_mbox_ids[] = {
85*4882a593Smuzhiyun { .compatible = "sandbox,mbox" },
86*4882a593Smuzhiyun { }
87*4882a593Smuzhiyun };
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun struct mbox_ops sandbox_mbox_mbox_ops = {
90*4882a593Smuzhiyun .request = sandbox_mbox_request,
91*4882a593Smuzhiyun .free = sandbox_mbox_free,
92*4882a593Smuzhiyun .send = sandbox_mbox_send,
93*4882a593Smuzhiyun .recv = sandbox_mbox_recv,
94*4882a593Smuzhiyun };
95*4882a593Smuzhiyun
96*4882a593Smuzhiyun U_BOOT_DRIVER(sandbox_mbox) = {
97*4882a593Smuzhiyun .name = "sandbox_mbox",
98*4882a593Smuzhiyun .id = UCLASS_MAILBOX,
99*4882a593Smuzhiyun .of_match = sandbox_mbox_ids,
100*4882a593Smuzhiyun .bind = sandbox_mbox_bind,
101*4882a593Smuzhiyun .probe = sandbox_mbox_probe,
102*4882a593Smuzhiyun .priv_auto_alloc_size = sizeof(struct sandbox_mbox),
103*4882a593Smuzhiyun .ops = &sandbox_mbox_mbox_ops,
104*4882a593Smuzhiyun };
105