Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 1 | /* |
Mikael Olsson | d4ad9e5 | 2024-02-07 11:22:26 +0100 | [diff] [blame] | 2 | * SPDX-FileCopyrightText: Copyright 2020, 2022-2024 Arm Limited and/or its affiliates <open-source-office@arm.com> |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 3 | * SPDX-License-Identifier: GPL-2.0-only |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 4 | * |
| 5 | * This program is free software and is provided to you under the terms of the |
| 6 | * GNU General Public License version 2 as published by the Free Software |
| 7 | * Foundation, and any use by you of this program is subject to the terms |
| 8 | * of such GNU licence. |
| 9 | * |
| 10 | * This program is distributed in the hope that it will be useful, |
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 13 | * GNU General Public License for more details. |
| 14 | * |
| 15 | * You should have received a copy of the GNU General Public License |
| 16 | * along with this program; if not, you can access it online at |
| 17 | * http://www.gnu.org/licenses/gpl-2.0.html. |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 18 | */ |
| 19 | |
| 20 | /**************************************************************************** |
| 21 | * Includes |
| 22 | ****************************************************************************/ |
| 23 | |
Mikael Olsson | d4ad9e5 | 2024-02-07 11:22:26 +0100 | [diff] [blame] | 24 | #include <rpmsg/ethosu_rpmsg_inference.h> |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 25 | |
Mikael Olsson | d4ad9e5 | 2024-02-07 11:22:26 +0100 | [diff] [blame] | 26 | #include <common/ethosu_buffer.h> |
| 27 | #include <common/ethosu_device.h> |
| 28 | #include <rpmsg/ethosu_rpmsg.h> |
| 29 | #include <rpmsg/ethosu_rpmsg_cancel_inference.h> |
| 30 | #include <rpmsg/ethosu_rpmsg_network.h> |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 31 | |
| 32 | #include <linux/anon_inodes.h> |
| 33 | #include <linux/file.h> |
| 34 | #include <linux/fs.h> |
| 35 | #include <linux/poll.h> |
| 36 | |
| 37 | /**************************************************************************** |
| 38 | * Variables |
| 39 | ****************************************************************************/ |
| 40 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 41 | static int ethosu_rpmsg_inference_release(struct inode *inode, |
| 42 | struct file *file); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 43 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 44 | static __poll_t ethosu_rpmsg_inference_poll(struct file *file, |
| 45 | poll_table *wait); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 46 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 47 | static long ethosu_rpmsg_inference_ioctl(struct file *file, |
| 48 | unsigned int cmd, |
| 49 | unsigned long arg); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 50 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 51 | static const struct file_operations ethosu_rpmsg_inference_fops = { |
| 52 | .release = ðosu_rpmsg_inference_release, |
| 53 | .poll = ðosu_rpmsg_inference_poll, |
| 54 | .unlocked_ioctl = ðosu_rpmsg_inference_ioctl, |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 55 | #ifdef CONFIG_COMPAT |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 56 | .compat_ioctl = ðosu_rpmsg_inference_ioctl, |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 57 | #endif |
| 58 | }; |
| 59 | |
| 60 | /**************************************************************************** |
| 61 | * Functions |
| 62 | ****************************************************************************/ |
| 63 | |
| 64 | static const char *status_to_string(const enum ethosu_uapi_status status) |
| 65 | { |
| 66 | switch (status) { |
| 67 | case ETHOSU_UAPI_STATUS_OK: { |
| 68 | return "Ok"; |
| 69 | } |
| 70 | case ETHOSU_UAPI_STATUS_ERROR: { |
| 71 | return "Error"; |
| 72 | } |
Davide Grohmann | 82d2258 | 2022-04-25 12:52:38 +0200 | [diff] [blame] | 73 | case ETHOSU_UAPI_STATUS_RUNNING: { |
| 74 | return "Running"; |
| 75 | } |
| 76 | case ETHOSU_UAPI_STATUS_REJECTED: { |
| 77 | return "Rejected"; |
| 78 | } |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 79 | case ETHOSU_UAPI_STATUS_ABORTED: { |
| 80 | return "Aborted"; |
| 81 | } |
| 82 | case ETHOSU_UAPI_STATUS_ABORTING: { |
| 83 | return "Aborting"; |
| 84 | } |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 85 | default: { |
| 86 | return "Unknown"; |
| 87 | } |
| 88 | } |
| 89 | } |
| 90 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 91 | static int ethosu_rpmsg_inference_send(struct ethosu_rpmsg_inference *inf) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 92 | { |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 93 | struct device *dev = inf->dev; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 94 | int ret; |
| 95 | |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 96 | inf->status = ETHOSU_UAPI_STATUS_ERROR; |
| 97 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 98 | ret = ethosu_rpmsg_mailbox_inference(inf->mailbox, &inf->msg, |
| 99 | inf->ifm_count, inf->ifm, |
| 100 | inf->ofm_count, inf->ofm, |
| 101 | inf->net, inf->pmu_event_config, |
| 102 | ETHOSU_PMU_EVENT_MAX, |
| 103 | inf->pmu_cycle_counter_enable); |
Kristofer Jonsson | 2d69b8b | 2022-06-30 15:34:52 +0200 | [diff] [blame] | 104 | if (ret) { |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 105 | dev_warn(dev, |
Kristofer Jonsson | 2d69b8b | 2022-06-30 15:34:52 +0200 | [diff] [blame] | 106 | "Failed to send inference request. inf=0x%pK, ret=%d", |
| 107 | inf, ret); |
| 108 | |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 109 | return ret; |
Kristofer Jonsson | 2d69b8b | 2022-06-30 15:34:52 +0200 | [diff] [blame] | 110 | } |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 111 | |
Davide Grohmann | 82d2258 | 2022-04-25 12:52:38 +0200 | [diff] [blame] | 112 | inf->status = ETHOSU_UAPI_STATUS_RUNNING; |
| 113 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 114 | ethosu_rpmsg_inference_get(inf); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 115 | |
| 116 | return 0; |
| 117 | } |
| 118 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 119 | static void ethosu_rpmsg_inference_fail(struct ethosu_rpmsg_mailbox_msg *msg) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 120 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 121 | struct ethosu_rpmsg_inference *inf = |
Kristofer Jonsson | 442fefb | 2022-03-17 17:15:52 +0100 | [diff] [blame] | 122 | container_of(msg, typeof(*inf), msg); |
| 123 | int ret; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 124 | |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 125 | if (inf->done) |
| 126 | return; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 127 | |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 128 | /* Decrement reference count if inference was pending reponse */ |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 129 | ret = ethosu_rpmsg_inference_put(inf); |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 130 | if (ret) |
| 131 | return; |
| 132 | |
| 133 | /* Set status accordingly to the inference state */ |
| 134 | inf->status = inf->status == ETHOSU_UAPI_STATUS_ABORTING ? |
| 135 | ETHOSU_UAPI_STATUS_ABORTED : |
| 136 | ETHOSU_UAPI_STATUS_ERROR; |
| 137 | /* Mark it done and wake up the waiting process */ |
Kristofer Jonsson | 442fefb | 2022-03-17 17:15:52 +0100 | [diff] [blame] | 138 | inf->done = true; |
| 139 | wake_up_interruptible(&inf->waitq); |
| 140 | } |
| 141 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 142 | static bool ethosu_rpmsg_inference_verify(struct file *file) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 143 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 144 | return file->f_op == ðosu_rpmsg_inference_fops; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 145 | } |
| 146 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 147 | static void ethosu_rpmsg_inference_kref_destroy(struct kref *kref) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 148 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 149 | struct ethosu_rpmsg_inference *inf = |
| 150 | container_of(kref, struct ethosu_rpmsg_inference, kref); |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 151 | struct device *dev = inf->dev; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 152 | |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 153 | dev_dbg(dev, |
| 154 | "Inference destroy. inf=0x%pK, status=%d, ifm_count=%u, ofm_count=%u", |
| 155 | inf, inf->status, inf->ifm_count, inf->ofm_count); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 156 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 157 | ethosu_rpmsg_mailbox_deregister(inf->mailbox, &inf->msg); |
Kristofer Jonsson | b74492c | 2020-09-10 13:26:01 +0200 | [diff] [blame] | 158 | |
| 159 | while (inf->ifm_count-- > 0) |
| 160 | ethosu_buffer_put(inf->ifm[inf->ifm_count]); |
| 161 | |
| 162 | while (inf->ofm_count-- > 0) |
| 163 | ethosu_buffer_put(inf->ofm[inf->ofm_count]); |
| 164 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 165 | ethosu_rpmsg_network_put(inf->net); |
Mikael Olsson | 1182f38 | 2023-08-10 13:25:44 +0200 | [diff] [blame] | 166 | memset(inf, 0, sizeof(*inf)); |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 167 | devm_kfree(dev, inf); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 168 | } |
| 169 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 170 | static int ethosu_rpmsg_inference_release(struct inode *inode, |
| 171 | struct file *file) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 172 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 173 | struct ethosu_rpmsg_inference *inf = file->private_data; |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 174 | struct device *dev = inf->dev; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 175 | |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 176 | dev_dbg(dev, |
| 177 | "Inference release. file=0x%pK, inf=0x%pK", |
| 178 | file, inf); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 179 | |
Mikael Olsson | 529cfad | 2023-06-14 17:14:14 +0200 | [diff] [blame] | 180 | device_lock(dev); |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 181 | ethosu_rpmsg_inference_put(inf); |
Mikael Olsson | 529cfad | 2023-06-14 17:14:14 +0200 | [diff] [blame] | 182 | device_unlock(dev); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 183 | |
| 184 | return 0; |
| 185 | } |
| 186 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 187 | static __poll_t ethosu_rpmsg_inference_poll(struct file *file, |
| 188 | poll_table *wait) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 189 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 190 | struct ethosu_rpmsg_inference *inf = file->private_data; |
Mikael Olsson | b682431 | 2023-11-14 10:43:04 +0100 | [diff] [blame] | 191 | __poll_t ret = 0; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 192 | |
| 193 | poll_wait(file, &inf->waitq, wait); |
| 194 | |
Kristofer Jonsson | 442fefb | 2022-03-17 17:15:52 +0100 | [diff] [blame] | 195 | if (inf->done) |
Mikael Olsson | b682431 | 2023-11-14 10:43:04 +0100 | [diff] [blame] | 196 | ret |= EPOLLIN; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 197 | |
| 198 | return ret; |
| 199 | } |
| 200 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 201 | static long ethosu_rpmsg_inference_ioctl(struct file *file, |
| 202 | unsigned int cmd, |
| 203 | unsigned long arg) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 204 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 205 | struct ethosu_rpmsg_inference *inf = file->private_data; |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 206 | struct device *dev = inf->dev; |
Per Åstrand | f7e407a | 2020-10-23 21:25:05 +0200 | [diff] [blame] | 207 | void __user *udata = (void __user *)arg; |
| 208 | int ret; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 209 | |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 210 | ret = device_lock_interruptible(dev); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 211 | if (ret) |
| 212 | return ret; |
| 213 | |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 214 | switch (cmd) { |
| 215 | case ETHOSU_IOCTL_INFERENCE_STATUS: { |
Mikael Olsson | ec90223 | 2023-08-24 13:28:19 +0200 | [diff] [blame] | 216 | struct ethosu_uapi_result_status uapi = { 0 }; |
Per Åstrand | f7e407a | 2020-10-23 21:25:05 +0200 | [diff] [blame] | 217 | int i; |
| 218 | |
| 219 | uapi.status = inf->status; |
| 220 | |
| 221 | for (i = 0; i < ETHOSU_PMU_EVENT_MAX; i++) { |
| 222 | uapi.pmu_config.events[i] = |
| 223 | inf->pmu_event_config[i]; |
| 224 | uapi.pmu_count.events[i] = |
| 225 | inf->pmu_event_count[i]; |
| 226 | } |
| 227 | |
| 228 | uapi.pmu_config.cycle_count = inf->pmu_cycle_counter_enable; |
| 229 | uapi.pmu_count.cycle_count = inf->pmu_cycle_counter_count; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 230 | |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 231 | dev_dbg(dev, |
| 232 | "Inference ioctl: Inference status. status=%s (%d)\n", |
| 233 | status_to_string(uapi.status), uapi.status); |
Per Åstrand | f7e407a | 2020-10-23 21:25:05 +0200 | [diff] [blame] | 234 | |
| 235 | ret = copy_to_user(udata, &uapi, sizeof(uapi)) ? -EFAULT : 0; |
| 236 | |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 237 | break; |
| 238 | } |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 239 | case ETHOSU_IOCTL_INFERENCE_CANCEL: { |
Mikael Olsson | ec90223 | 2023-08-24 13:28:19 +0200 | [diff] [blame] | 240 | struct ethosu_uapi_cancel_inference_status uapi = { 0 }; |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 241 | |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 242 | dev_dbg(dev, |
| 243 | "Inference ioctl: Cancel Inference. Handle=%p\n", |
| 244 | inf); |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 245 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 246 | ret = ethosu_rpmsg_cancel_inference_request(dev, inf->mailbox, |
| 247 | inf, |
| 248 | &uapi); |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 249 | if (ret) |
| 250 | break; |
| 251 | |
| 252 | ret = copy_to_user(udata, &uapi, sizeof(uapi)) ? -EFAULT : 0; |
| 253 | |
| 254 | break; |
| 255 | } |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 256 | default: { |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 257 | dev_err(dev, "Invalid ioctl. cmd=%u, arg=%lu\n", |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 258 | cmd, arg); |
Mikael Olsson | 891156d | 2023-08-24 13:20:31 +0200 | [diff] [blame] | 259 | ret = -ENOIOCTLCMD; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 260 | break; |
| 261 | } |
| 262 | } |
| 263 | |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 264 | device_unlock(dev); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 265 | |
| 266 | return ret; |
| 267 | } |
| 268 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 269 | int ethosu_rpmsg_inference_create(struct device *dev, |
| 270 | struct ethosu_rpmsg_mailbox *mailbox, |
| 271 | struct ethosu_rpmsg_network *net, |
| 272 | struct ethosu_uapi_inference_create *uapi) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 273 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 274 | struct ethosu_rpmsg_inference *inf; |
Kristofer Jonsson | b74492c | 2020-09-10 13:26:01 +0200 | [diff] [blame] | 275 | uint32_t i; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 276 | int fd; |
| 277 | int ret = -ENOMEM; |
| 278 | |
Kristofer Jonsson | 2d69b8b | 2022-06-30 15:34:52 +0200 | [diff] [blame] | 279 | if (uapi->ifm_count > ETHOSU_FD_MAX || |
| 280 | uapi->ofm_count > ETHOSU_FD_MAX) { |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 281 | dev_warn(dev, |
Kristofer Jonsson | 2d69b8b | 2022-06-30 15:34:52 +0200 | [diff] [blame] | 282 | "Too many IFM and/or OFM buffers for inference. ifm_count=%u, ofm_count=%u", |
| 283 | uapi->ifm_count, uapi->ofm_count); |
| 284 | |
| 285 | return -EFAULT; |
| 286 | } |
| 287 | |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 288 | inf = devm_kzalloc(dev, sizeof(*inf), GFP_KERNEL); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 289 | if (!inf) |
| 290 | return -ENOMEM; |
| 291 | |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 292 | inf->dev = dev; |
| 293 | inf->mailbox = mailbox; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 294 | inf->net = net; |
Kristofer Jonsson | 442fefb | 2022-03-17 17:15:52 +0100 | [diff] [blame] | 295 | inf->done = false; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 296 | inf->status = ETHOSU_UAPI_STATUS_ERROR; |
| 297 | kref_init(&inf->kref); |
| 298 | init_waitqueue_head(&inf->waitq); |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 299 | inf->msg.fail = ethosu_rpmsg_inference_fail; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 300 | |
Davide Grohmann | 32660f9 | 2022-04-27 16:49:07 +0200 | [diff] [blame] | 301 | /* Add inference to pending list */ |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 302 | ret = ethosu_rpmsg_mailbox_register(mailbox, &inf->msg); |
Davide Grohmann | 32660f9 | 2022-04-27 16:49:07 +0200 | [diff] [blame] | 303 | if (ret < 0) |
| 304 | goto kfree; |
| 305 | |
Kristofer Jonsson | b74492c | 2020-09-10 13:26:01 +0200 | [diff] [blame] | 306 | /* Get pointer to IFM buffers */ |
| 307 | for (i = 0; i < uapi->ifm_count; i++) { |
| 308 | inf->ifm[i] = ethosu_buffer_get_from_fd(uapi->ifm_fd[i]); |
| 309 | if (IS_ERR(inf->ifm[i])) { |
| 310 | ret = PTR_ERR(inf->ifm[i]); |
| 311 | goto put_ifm; |
| 312 | } |
| 313 | |
| 314 | inf->ifm_count++; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 315 | } |
| 316 | |
| 317 | /* Get pointer to OFM buffer */ |
Kristofer Jonsson | b74492c | 2020-09-10 13:26:01 +0200 | [diff] [blame] | 318 | for (i = 0; i < uapi->ofm_count; i++) { |
| 319 | inf->ofm[i] = ethosu_buffer_get_from_fd(uapi->ofm_fd[i]); |
| 320 | if (IS_ERR(inf->ofm[i])) { |
| 321 | ret = PTR_ERR(inf->ofm[i]); |
| 322 | goto put_ofm; |
| 323 | } |
| 324 | |
| 325 | inf->ofm_count++; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 326 | } |
| 327 | |
Per Åstrand | f7e407a | 2020-10-23 21:25:05 +0200 | [diff] [blame] | 328 | /* Configure PMU and cycle counter */ |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 329 | dev_dbg(dev, |
| 330 | "Configuring events for PMU. events=[%u, %u, %u, %u]\n", |
| 331 | uapi->pmu_config.events[0], uapi->pmu_config.events[1], |
| 332 | uapi->pmu_config.events[2], uapi->pmu_config.events[3]); |
Per Åstrand | f7e407a | 2020-10-23 21:25:05 +0200 | [diff] [blame] | 333 | |
| 334 | /* Configure events and reset count for all events */ |
| 335 | for (i = 0; i < ETHOSU_PMU_EVENT_MAX; i++) { |
| 336 | inf->pmu_event_config[i] = uapi->pmu_config.events[i]; |
| 337 | inf->pmu_event_count[i] = 0; |
| 338 | } |
| 339 | |
Per Åstrand | f7e407a | 2020-10-23 21:25:05 +0200 | [diff] [blame] | 340 | /* Configure cycle counter and reset any previous count */ |
| 341 | inf->pmu_cycle_counter_enable = uapi->pmu_config.cycle_count; |
| 342 | inf->pmu_cycle_counter_count = 0; |
| 343 | |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 344 | /* Increment network reference count */ |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 345 | ethosu_rpmsg_network_get(net); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 346 | |
Kristofer Jonsson | 2d69b8b | 2022-06-30 15:34:52 +0200 | [diff] [blame] | 347 | /* Send inference request to Arm Ethos-U subsystem */ |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 348 | ret = ethosu_rpmsg_inference_send(inf); |
Kristofer Jonsson | 2d69b8b | 2022-06-30 15:34:52 +0200 | [diff] [blame] | 349 | if (ret) |
| 350 | goto put_net; |
| 351 | |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 352 | /* Create file descriptor */ |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 353 | ret = fd = anon_inode_getfd("ethosu-inference", |
| 354 | ðosu_rpmsg_inference_fops, |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 355 | inf, O_RDWR | O_CLOEXEC); |
| 356 | if (ret < 0) |
| 357 | goto put_net; |
| 358 | |
| 359 | /* Store pointer to file structure */ |
| 360 | inf->file = fget(ret); |
| 361 | fput(inf->file); |
| 362 | |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 363 | dev_dbg(dev, |
| 364 | "Inference create. file=0x%pK, fd=%d, inf=0x%p, net=0x%pK, msg.id=0x%x", |
| 365 | inf->file, fd, inf, inf->net, inf->msg.id); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 366 | |
| 367 | return fd; |
| 368 | |
| 369 | put_net: |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 370 | ethosu_rpmsg_network_put(inf->net); |
Kristofer Jonsson | b74492c | 2020-09-10 13:26:01 +0200 | [diff] [blame] | 371 | |
| 372 | put_ofm: |
| 373 | while (inf->ofm_count-- > 0) |
| 374 | ethosu_buffer_put(inf->ofm[inf->ofm_count]); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 375 | |
| 376 | put_ifm: |
Kristofer Jonsson | b74492c | 2020-09-10 13:26:01 +0200 | [diff] [blame] | 377 | while (inf->ifm_count-- > 0) |
| 378 | ethosu_buffer_put(inf->ifm[inf->ifm_count]); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 379 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 380 | ethosu_rpmsg_mailbox_deregister(mailbox, &inf->msg); |
Mikael Olsson | 27fe8e0 | 2023-08-23 10:43:08 +0200 | [diff] [blame] | 381 | |
Davide Grohmann | 32660f9 | 2022-04-27 16:49:07 +0200 | [diff] [blame] | 382 | kfree: |
Mikael Olsson | 1182f38 | 2023-08-10 13:25:44 +0200 | [diff] [blame] | 383 | memset(inf, 0, sizeof(*inf)); |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 384 | devm_kfree(dev, inf); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 385 | |
| 386 | return ret; |
| 387 | } |
| 388 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 389 | struct ethosu_rpmsg_inference *ethosu_rpmsg_inference_get_from_fd(int fd) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 390 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 391 | struct ethosu_rpmsg_inference *inf; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 392 | struct file *file; |
| 393 | |
| 394 | file = fget(fd); |
| 395 | if (!file) |
| 396 | return ERR_PTR(-EINVAL); |
| 397 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 398 | if (!ethosu_rpmsg_inference_verify(file)) { |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 399 | fput(file); |
| 400 | |
| 401 | return ERR_PTR(-EINVAL); |
| 402 | } |
| 403 | |
| 404 | inf = file->private_data; |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 405 | ethosu_rpmsg_inference_get(inf); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 406 | fput(file); |
| 407 | |
| 408 | return inf; |
| 409 | } |
| 410 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 411 | void ethosu_rpmsg_inference_get(struct ethosu_rpmsg_inference *inf) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 412 | { |
| 413 | kref_get(&inf->kref); |
| 414 | } |
| 415 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 416 | int ethosu_rpmsg_inference_put(struct ethosu_rpmsg_inference *inf) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 417 | { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 418 | return kref_put(&inf->kref, ðosu_rpmsg_inference_kref_destroy); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 419 | } |
| 420 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 421 | void ethosu_rpmsg_inference_rsp(struct ethosu_rpmsg_mailbox *mailbox, |
| 422 | int msg_id, |
| 423 | struct ethosu_rpmsg_inference_rsp *rsp) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 424 | { |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 425 | struct device *dev = mailbox->dev; |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 426 | struct ethosu_rpmsg_mailbox_msg *msg; |
| 427 | struct ethosu_rpmsg_inference *inf; |
Per Åstrand | f7e407a | 2020-10-23 21:25:05 +0200 | [diff] [blame] | 428 | int i; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 429 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 430 | msg = ethosu_rpmsg_mailbox_find(mailbox, msg_id, |
| 431 | ETHOSU_RPMSG_INFERENCE_REQ); |
Davide Grohmann | 32660f9 | 2022-04-27 16:49:07 +0200 | [diff] [blame] | 432 | if (IS_ERR(msg)) { |
Kristofer Jonsson | ec47704 | 2023-01-20 13:38:13 +0100 | [diff] [blame] | 433 | dev_warn(dev, |
Mikael Olsson | 09965b0 | 2023-06-13 12:17:04 +0200 | [diff] [blame] | 434 | "Id for inference msg not found. Id=0x%x: %ld\n", |
| 435 | msg_id, PTR_ERR(msg)); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 436 | |
| 437 | return; |
| 438 | } |
| 439 | |
Davide Grohmann | 32660f9 | 2022-04-27 16:49:07 +0200 | [diff] [blame] | 440 | inf = container_of(msg, typeof(*inf), msg); |
| 441 | |
Mikael Olsson | 6d5e2d2 | 2024-01-16 11:19:09 +0100 | [diff] [blame] | 442 | /* |
| 443 | * Don't handle the response if the inference is aborted or |
| 444 | * in the process of being aborted |
| 445 | */ |
| 446 | if (inf->status == ETHOSU_UAPI_STATUS_ABORTED || |
| 447 | inf->status == ETHOSU_UAPI_STATUS_ABORTING) { |
| 448 | inf->status = ETHOSU_UAPI_STATUS_ABORTED; |
| 449 | goto done; |
| 450 | } |
| 451 | |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 452 | if (rsp->status == ETHOSU_RPMSG_STATUS_OK && |
| 453 | inf->ofm_count <= ETHOSU_RPMSG_BUFFER_MAX) |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 454 | inf->status = ETHOSU_UAPI_STATUS_OK; |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 455 | else if (rsp->status == ETHOSU_RPMSG_STATUS_REJECTED) |
Davide Grohmann | 82d2258 | 2022-04-25 12:52:38 +0200 | [diff] [blame] | 456 | inf->status = ETHOSU_UAPI_STATUS_REJECTED; |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 457 | else if (rsp->status == ETHOSU_RPMSG_STATUS_ABORTED) |
Davide Grohmann | 7e8f508 | 2022-03-23 12:48:45 +0100 | [diff] [blame] | 458 | inf->status = ETHOSU_UAPI_STATUS_ABORTED; |
Mikael Olsson | 0754515 | 2023-10-17 13:05:38 +0200 | [diff] [blame] | 459 | else |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 460 | inf->status = ETHOSU_UAPI_STATUS_ERROR; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 461 | |
Davide Grohmann | 82d2258 | 2022-04-25 12:52:38 +0200 | [diff] [blame] | 462 | if (inf->status == ETHOSU_UAPI_STATUS_OK) { |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 463 | for (i = 0; i < ETHOSU_RPMSG_PMU_MAX; i++) { |
Davide Grohmann | 82d2258 | 2022-04-25 12:52:38 +0200 | [diff] [blame] | 464 | inf->pmu_event_config[i] = rsp->pmu_event_config[i]; |
| 465 | inf->pmu_event_count[i] = rsp->pmu_event_count[i]; |
| 466 | } |
| 467 | |
| 468 | inf->pmu_cycle_counter_enable = rsp->pmu_cycle_counter_enable; |
| 469 | inf->pmu_cycle_counter_count = rsp->pmu_cycle_counter_count; |
| 470 | |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 471 | dev_dbg(dev, |
Mikael Olsson | e87446c | 2023-12-15 17:17:06 +0100 | [diff] [blame] | 472 | "PMU events. config=[%u, %u, %u, %u], count=[%llu, %llu, %llu, %llu]\n", |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 473 | inf->pmu_event_config[0], inf->pmu_event_config[1], |
| 474 | inf->pmu_event_config[2], inf->pmu_event_config[3], |
| 475 | inf->pmu_event_count[0], inf->pmu_event_count[1], |
| 476 | inf->pmu_event_count[2], inf->pmu_event_count[3]); |
Davide Grohmann | 82d2258 | 2022-04-25 12:52:38 +0200 | [diff] [blame] | 477 | |
Ledion Daja | edd2550 | 2023-10-17 09:15:32 +0200 | [diff] [blame] | 478 | if (inf->pmu_cycle_counter_enable) |
| 479 | dev_dbg(dev, |
| 480 | "PMU cycle counter: count=%llu\n", |
| 481 | inf->pmu_cycle_counter_count); |
Per Åstrand | f7e407a | 2020-10-23 21:25:05 +0200 | [diff] [blame] | 482 | } |
| 483 | |
Mikael Olsson | 6d5e2d2 | 2024-01-16 11:19:09 +0100 | [diff] [blame] | 484 | done: |
Kristofer Jonsson | 442fefb | 2022-03-17 17:15:52 +0100 | [diff] [blame] | 485 | inf->done = true; |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 486 | wake_up_interruptible(&inf->waitq); |
Mikael Olsson | 16be285 | 2024-02-12 09:56:56 +0100 | [diff] [blame^] | 487 | ethosu_rpmsg_inference_put(inf); |
Kristofer Jonsson | 116a635 | 2020-08-20 17:25:23 +0200 | [diff] [blame] | 488 | } |