diff options
author | Teo Hall <teo.hall@nxp.com> | 2016-09-12 14:12:25 -0500 |
---|---|---|
committer | Ye Li <ye.li@nxp.com> | 2018-04-27 02:32:30 -0700 |
commit | afcfb7e5105ef01ec46a6c896b20e210a07ee094 (patch) | |
tree | 22033d701a4725f7eacdaedff5b4e0d6b4c8fa7a | |
parent | 3733fc85c1f29f2d0ac2af42eca64d5939902fe3 (diff) |
MLK-14938-23 mailbox: enable mbox_send non-blocking use
Add a timeout to allow non-blocking use in the
same way as mbox_recv
Signed-off-by: Teo Hall <teo.hall@nxp.com>
(cherry picked from commit c2296701fa91dc8d4144c84c19ffe40dba3df88c)
-rw-r--r-- | drivers/mailbox/mailbox-uclass.c | 20 | ||||
-rw-r--r-- | include/mailbox.h | 2 |
2 files changed, 19 insertions, 3 deletions
diff --git a/drivers/mailbox/mailbox-uclass.c b/drivers/mailbox/mailbox-uclass.c index 822ae5b45e5..e149bf5dca4 100644 --- a/drivers/mailbox/mailbox-uclass.c +++ b/drivers/mailbox/mailbox-uclass.c @@ -100,13 +100,29 @@ int mbox_free(struct mbox_chan *chan) return ops->free(chan); } -int mbox_send(struct mbox_chan *chan, const void *data) +int mbox_send(struct mbox_chan *chan, const void *data, ulong timeout_us) { struct mbox_ops *ops = mbox_dev_ops(chan->dev); + ulong start_time; + int ret; debug("%s(chan=%p, data=%p)\n", __func__, chan, data); - return ops->send(chan, data); + start_time = timer_get_us(); + /* + * Account for partial us ticks, but if timeout_us is 0, ensure we + * still don't wait at all. + */ + if (timeout_us) + timeout_us++; + + for (;;) { + ret = ops->send(chan, data); + if (ret != -EBUSY) + return ret; + if ((timer_get_us() - start_time) >= timeout_us) + return -ETIMEDOUT; + } } int mbox_recv(struct mbox_chan *chan, void *data, ulong timeout_us) diff --git a/include/mailbox.h b/include/mailbox.h index a92a1a590df..8d89f3f99ee 100644 --- a/include/mailbox.h +++ b/include/mailbox.h @@ -124,7 +124,7 @@ int mbox_free(struct mbox_chan *chan); * will ignore this parameter. * @return 0 if OK, or a negative error code. */ -int mbox_send(struct mbox_chan *chan, const void *data); +int mbox_send(struct mbox_chan *chan, const void *data, ulong timeout_us); /** * mbox_recv - Receive any available message from a mailbox channel |