Root/
| 1 | /* |
| 2 | * OMAP Remote Processor driver |
| 3 | * |
| 4 | * Copyright (C) 2011 Texas Instruments, Inc. |
| 5 | * Copyright (C) 2011 Google, Inc. |
| 6 | * |
| 7 | * Ohad Ben-Cohen <ohad@wizery.com> |
| 8 | * Brian Swetland <swetland@google.com> |
| 9 | * Fernando Guzman Lugo <fernando.lugo@ti.com> |
| 10 | * Mark Grosen <mgrosen@ti.com> |
| 11 | * Suman Anna <s-anna@ti.com> |
| 12 | * Hari Kanigeri <h-kanigeri2@ti.com> |
| 13 | * |
| 14 | * This program is free software; you can redistribute it and/or |
| 15 | * modify it under the terms of the GNU General Public License |
| 16 | * version 2 as published by the Free Software Foundation. |
| 17 | * |
| 18 | * This program is distributed in the hope that it will be useful, |
| 19 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 20 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 21 | * GNU General Public License for more details. |
| 22 | */ |
| 23 | |
| 24 | #include <linux/kernel.h> |
| 25 | #include <linux/module.h> |
| 26 | #include <linux/err.h> |
| 27 | #include <linux/platform_device.h> |
| 28 | #include <linux/dma-mapping.h> |
| 29 | #include <linux/remoteproc.h> |
| 30 | |
| 31 | #include <plat/mailbox.h> |
| 32 | #include <plat/remoteproc.h> |
| 33 | |
| 34 | #include "omap_remoteproc.h" |
| 35 | #include "remoteproc_internal.h" |
| 36 | |
| 37 | /** |
| 38 | * struct omap_rproc - omap remote processor state |
| 39 | * @mbox: omap mailbox handle |
| 40 | * @nb: notifier block that will be invoked on inbound mailbox messages |
| 41 | * @rproc: rproc handle |
| 42 | */ |
| 43 | struct omap_rproc { |
| 44 | struct omap_mbox *mbox; |
| 45 | struct notifier_block nb; |
| 46 | struct rproc *rproc; |
| 47 | }; |
| 48 | |
| 49 | /** |
| 50 | * omap_rproc_mbox_callback() - inbound mailbox message handler |
| 51 | * @this: notifier block |
| 52 | * @index: unused |
| 53 | * @data: mailbox payload |
| 54 | * |
| 55 | * This handler is invoked by omap's mailbox driver whenever a mailbox |
| 56 | * message is received. Usually, the mailbox payload simply contains |
| 57 | * the index of the virtqueue that is kicked by the remote processor, |
| 58 | * and we let remoteproc core handle it. |
| 59 | * |
| 60 | * In addition to virtqueue indices, we also have some out-of-band values |
| 61 | * that indicates different events. Those values are deliberately very |
| 62 | * big so they don't coincide with virtqueue indices. |
| 63 | */ |
| 64 | static int omap_rproc_mbox_callback(struct notifier_block *this, |
| 65 | unsigned long index, void *data) |
| 66 | { |
| 67 | mbox_msg_t msg = (mbox_msg_t) data; |
| 68 | struct omap_rproc *oproc = container_of(this, struct omap_rproc, nb); |
| 69 | struct device *dev = oproc->rproc->dev.parent; |
| 70 | const char *name = oproc->rproc->name; |
| 71 | |
| 72 | dev_dbg(dev, "mbox msg: 0x%x\n", msg); |
| 73 | |
| 74 | switch (msg) { |
| 75 | case RP_MBOX_CRASH: |
| 76 | /* just log this for now. later, we'll also do recovery */ |
| 77 | dev_err(dev, "omap rproc %s crashed\n", name); |
| 78 | break; |
| 79 | case RP_MBOX_ECHO_REPLY: |
| 80 | dev_info(dev, "received echo reply from %s\n", name); |
| 81 | break; |
| 82 | default: |
| 83 | /* msg contains the index of the triggered vring */ |
| 84 | if (rproc_vq_interrupt(oproc->rproc, msg) == IRQ_NONE) |
| 85 | dev_dbg(dev, "no message was found in vqid %d\n", msg); |
| 86 | } |
| 87 | |
| 88 | return NOTIFY_DONE; |
| 89 | } |
| 90 | |
| 91 | /* kick a virtqueue */ |
| 92 | static void omap_rproc_kick(struct rproc *rproc, int vqid) |
| 93 | { |
| 94 | struct omap_rproc *oproc = rproc->priv; |
| 95 | struct device *dev = rproc->dev.parent; |
| 96 | int ret; |
| 97 | |
| 98 | /* send the index of the triggered virtqueue in the mailbox payload */ |
| 99 | ret = omap_mbox_msg_send(oproc->mbox, vqid); |
| 100 | if (ret) |
| 101 | dev_err(dev, "omap_mbox_msg_send failed: %d\n", ret); |
| 102 | } |
| 103 | |
| 104 | /* |
| 105 | * Power up the remote processor. |
| 106 | * |
| 107 | * This function will be invoked only after the firmware for this rproc |
| 108 | * was loaded, parsed successfully, and all of its resource requirements |
| 109 | * were met. |
| 110 | */ |
| 111 | static int omap_rproc_start(struct rproc *rproc) |
| 112 | { |
| 113 | struct omap_rproc *oproc = rproc->priv; |
| 114 | struct device *dev = rproc->dev.parent; |
| 115 | struct platform_device *pdev = to_platform_device(dev); |
| 116 | struct omap_rproc_pdata *pdata = pdev->dev.platform_data; |
| 117 | int ret; |
| 118 | |
| 119 | oproc->nb.notifier_call = omap_rproc_mbox_callback; |
| 120 | |
| 121 | /* every omap rproc is assigned a mailbox instance for messaging */ |
| 122 | oproc->mbox = omap_mbox_get(pdata->mbox_name, &oproc->nb); |
| 123 | if (IS_ERR(oproc->mbox)) { |
| 124 | ret = PTR_ERR(oproc->mbox); |
| 125 | dev_err(dev, "omap_mbox_get failed: %d\n", ret); |
| 126 | return ret; |
| 127 | } |
| 128 | |
| 129 | /* |
| 130 | * Ping the remote processor. this is only for sanity-sake; |
| 131 | * there is no functional effect whatsoever. |
| 132 | * |
| 133 | * Note that the reply will _not_ arrive immediately: this message |
| 134 | * will wait in the mailbox fifo until the remote processor is booted. |
| 135 | */ |
| 136 | ret = omap_mbox_msg_send(oproc->mbox, RP_MBOX_ECHO_REQUEST); |
| 137 | if (ret) { |
| 138 | dev_err(dev, "omap_mbox_get failed: %d\n", ret); |
| 139 | goto put_mbox; |
| 140 | } |
| 141 | |
| 142 | ret = pdata->device_enable(pdev); |
| 143 | if (ret) { |
| 144 | dev_err(dev, "omap_device_enable failed: %d\n", ret); |
| 145 | goto put_mbox; |
| 146 | } |
| 147 | |
| 148 | return 0; |
| 149 | |
| 150 | put_mbox: |
| 151 | omap_mbox_put(oproc->mbox, &oproc->nb); |
| 152 | return ret; |
| 153 | } |
| 154 | |
| 155 | /* power off the remote processor */ |
| 156 | static int omap_rproc_stop(struct rproc *rproc) |
| 157 | { |
| 158 | struct device *dev = rproc->dev.parent; |
| 159 | struct platform_device *pdev = to_platform_device(dev); |
| 160 | struct omap_rproc_pdata *pdata = pdev->dev.platform_data; |
| 161 | struct omap_rproc *oproc = rproc->priv; |
| 162 | int ret; |
| 163 | |
| 164 | ret = pdata->device_shutdown(pdev); |
| 165 | if (ret) |
| 166 | return ret; |
| 167 | |
| 168 | omap_mbox_put(oproc->mbox, &oproc->nb); |
| 169 | |
| 170 | return 0; |
| 171 | } |
| 172 | |
| 173 | static struct rproc_ops omap_rproc_ops = { |
| 174 | .start = omap_rproc_start, |
| 175 | .stop = omap_rproc_stop, |
| 176 | .kick = omap_rproc_kick, |
| 177 | }; |
| 178 | |
| 179 | static int __devinit omap_rproc_probe(struct platform_device *pdev) |
| 180 | { |
| 181 | struct omap_rproc_pdata *pdata = pdev->dev.platform_data; |
| 182 | struct omap_rproc *oproc; |
| 183 | struct rproc *rproc; |
| 184 | int ret; |
| 185 | |
| 186 | ret = dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32)); |
| 187 | if (ret) { |
| 188 | dev_err(&pdev->dev, "dma_set_coherent_mask: %d\n", ret); |
| 189 | return ret; |
| 190 | } |
| 191 | |
| 192 | rproc = rproc_alloc(&pdev->dev, pdata->name, &omap_rproc_ops, |
| 193 | pdata->firmware, sizeof(*oproc)); |
| 194 | if (!rproc) |
| 195 | return -ENOMEM; |
| 196 | |
| 197 | oproc = rproc->priv; |
| 198 | oproc->rproc = rproc; |
| 199 | |
| 200 | platform_set_drvdata(pdev, rproc); |
| 201 | |
| 202 | ret = rproc_add(rproc); |
| 203 | if (ret) |
| 204 | goto free_rproc; |
| 205 | |
| 206 | return 0; |
| 207 | |
| 208 | free_rproc: |
| 209 | rproc_put(rproc); |
| 210 | return ret; |
| 211 | } |
| 212 | |
| 213 | static int __devexit omap_rproc_remove(struct platform_device *pdev) |
| 214 | { |
| 215 | struct rproc *rproc = platform_get_drvdata(pdev); |
| 216 | |
| 217 | rproc_del(rproc); |
| 218 | rproc_put(rproc); |
| 219 | |
| 220 | return 0; |
| 221 | } |
| 222 | |
| 223 | static struct platform_driver omap_rproc_driver = { |
| 224 | .probe = omap_rproc_probe, |
| 225 | .remove = __devexit_p(omap_rproc_remove), |
| 226 | .driver = { |
| 227 | .name = "omap-rproc", |
| 228 | .owner = THIS_MODULE, |
| 229 | }, |
| 230 | }; |
| 231 | |
| 232 | module_platform_driver(omap_rproc_driver); |
| 233 | |
| 234 | MODULE_LICENSE("GPL v2"); |
| 235 | MODULE_DESCRIPTION("OMAP Remote Processor control driver"); |
| 236 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9
