blob: 3382d350340dd77c7694c95a5ad4941f5c91fc96 [file] [log] [blame]
Andrew Jeffery4fe996c2018-02-27 12:16:48 +10301// SPDX-License-Identifier: Apache-2.0
2// Copyright (C) 2018 IBM Corp.
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +11003
4#define _GNU_SOURCE
5#include <assert.h>
6#include <errno.h>
7#include <fcntl.h>
8#include <getopt.h>
9#include <limits.h>
10#include <poll.h>
11#include <stdbool.h>
12#include <stdint.h>
13#include <stdio.h>
14#include <stdlib.h>
15#include <string.h>
16#include <syslog.h>
17#include <signal.h>
18#include <sys/ioctl.h>
19#include <sys/mman.h>
20#include <sys/stat.h>
21#include <sys/timerfd.h>
22#include <sys/types.h>
23#include <time.h>
24#include <unistd.h>
25#include <inttypes.h>
26
27#include "mbox.h"
28#include "common.h"
Andrew Jeffery457a6e52018-08-08 11:21:08 +093029#include "transport_mbox.h"
Andrew Jefferyf593b1b2018-08-08 11:01:04 +093030#include "windows.h"
Andrew Jefferycd186112018-08-08 10:47:55 +093031#include "lpc.h"
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +110032
Andrew Jeffery1e531af2018-08-07 13:32:57 +093033struct errno_map {
34 int rc;
35 int mbox_errno;
36};
37
38static const struct errno_map errno_map_v1[] = {
39 { 0, MBOX_R_SUCCESS },
40 { EACCES, MBOX_R_PARAM_ERROR },
41 { EBUSY, MBOX_R_SYSTEM_ERROR },
42 { EINVAL, MBOX_R_PARAM_ERROR },
43 { EPERM, MBOX_R_PARAM_ERROR },
44 { ETIMEDOUT, MBOX_R_TIMEOUT },
45 { -1, MBOX_R_SYSTEM_ERROR },
46};
47
48static const struct errno_map errno_map_v2[] = {
49 { 0, MBOX_R_SUCCESS },
50 { EACCES, MBOX_R_PARAM_ERROR },
51 { EBUSY, MBOX_R_BUSY },
52 { EINVAL, MBOX_R_PARAM_ERROR },
53 { EPERM, MBOX_R_WINDOW_ERROR },
54 { ETIMEDOUT, MBOX_R_TIMEOUT },
55 { -1, MBOX_R_SYSTEM_ERROR },
56};
57
58static const struct errno_map *errno_maps[] = {
59 [0] = NULL,
60 [1] = errno_map_v1,
61 [2] = errno_map_v2,
62};
63
64static inline int mbox_xlate_errno(struct mbox_context *context,
65 int rc)
66{
67 const struct errno_map *entry;
68
69 rc = -rc;
70 for(entry = errno_maps[context->version]; entry->rc != -1; entry++) {
71 if (rc == entry->rc) {
72 return -entry->mbox_errno;
73 }
74 }
75
76 return -entry->mbox_errno;
77}
78
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +110079/*
80 * write_bmc_event_reg() - Write to the BMC controlled status register (reg 15)
81 * @context: The mbox context pointer
82 *
83 * Return: 0 on success otherwise negative error code
84 */
85static int write_bmc_event_reg(struct mbox_context *context)
86{
87 int rc;
88
89 /* Seek mbox registers */
90 rc = lseek(context->fds[MBOX_FD].fd, MBOX_BMC_EVENT, SEEK_SET);
91 if (rc != MBOX_BMC_EVENT) {
92 MSG_ERR("Couldn't lseek mbox to byte %d: %s\n", MBOX_BMC_EVENT,
93 strerror(errno));
94 return -MBOX_R_SYSTEM_ERROR;
95 }
96
97 /* Write to mbox status register */
98 rc = write(context->fds[MBOX_FD].fd, &context->bmc_events, 1);
99 if (rc != 1) {
100 MSG_ERR("Couldn't write to BMC status reg: %s\n",
101 strerror(errno));
102 return -MBOX_R_SYSTEM_ERROR;
103 }
104
105 /* Reset to start */
106 rc = lseek(context->fds[MBOX_FD].fd, 0, SEEK_SET);
107 if (rc) {
108 MSG_ERR("Couldn't reset MBOX offset to zero: %s\n",
109 strerror(errno));
110 return -MBOX_R_SYSTEM_ERROR;
111 }
112
113 return 0;
114}
115
116/*
117 * set_bmc_events() - Set BMC events
118 * @context: The mbox context pointer
119 * @bmc_event: The bits to set
120 * @write_back: Whether to write back to the register -> will interrupt host
121 *
122 * Return: 0 on success otherwise negative error code
123 */
124int set_bmc_events(struct mbox_context *context, uint8_t bmc_event,
125 bool write_back)
126{
127 uint8_t mask = 0x00;
128
129 switch (context->version) {
130 case API_VERSION_1:
131 mask = BMC_EVENT_V1_MASK;
132 break;
133 default:
134 mask = BMC_EVENT_V2_MASK;
135 break;
136 }
137
138 context->bmc_events |= (bmc_event & mask);
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000139 MSG_DBG("BMC Events set to: 0x%.2x\n", context->bmc_events);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100140
141 return write_back ? write_bmc_event_reg(context) : 0;
142}
143
144/*
145 * clr_bmc_events() - Clear BMC events
146 * @context: The mbox context pointer
147 * @bmc_event: The bits to clear
148 * @write_back: Whether to write back to the register -> will interrupt host
149 *
150 * Return: 0 on success otherwise negative error code
151 */
152int clr_bmc_events(struct mbox_context *context, uint8_t bmc_event,
153 bool write_back)
154{
155 context->bmc_events &= ~bmc_event;
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000156 MSG_DBG("BMC Events clear to: 0x%.2x\n", context->bmc_events);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100157
158 return write_back ? write_bmc_event_reg(context) : 0;
159}
160
161/* Command Handlers */
162
163/*
164 * Command: RESET_STATE
Deepak Kodihalli017e45c2017-07-12 01:06:30 -0500165 * Reset the LPC mapping to point back at the flash, or memory in case we're
166 * using a virtual pnor.
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100167 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030168int mbox_handle_reset(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100169 union mbox_regs *req, struct mbox_msg *resp)
170{
Andrew Jefferyab666a52018-08-07 14:28:09 +0930171 int rc = context->protocol->reset(context);
172 if (rc < 0) {
173 return mbox_xlate_errno(context, rc);
174 }
175
176 return 0;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100177}
178
179/*
180 * Command: GET_MBOX_INFO
181 * Get the API version, default window size and block size
182 * We also set the LPC mapping to point to the reserved memory region here so
183 * this command must be called before any window manipulation
184 *
185 * V1:
186 * ARGS[0]: API Version
187 *
188 * RESP[0]: API Version
189 * RESP[1:2]: Default read window size (number of blocks)
190 * RESP[3:4]: Default write window size (number of blocks)
191 * RESP[5]: Block size (as shift)
192 *
193 * V2:
194 * ARGS[0]: API Version
195 *
196 * RESP[0]: API Version
197 * RESP[1:2]: Default read window size (number of blocks)
198 * RESP[3:4]: Default write window size (number of blocks)
199 * RESP[5]: Block size (as shift)
200 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030201int mbox_handle_mbox_info(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100202 union mbox_regs *req, struct mbox_msg *resp)
203{
204 uint8_t mbox_api_version = req->msg.args[0];
Andrew Jeffery1e531af2018-08-07 13:32:57 +0930205 struct protocol_get_info io = {
206 .req = { .api_version = mbox_api_version }
207 };
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100208 int rc;
209
Andrew Jeffery1e531af2018-08-07 13:32:57 +0930210 rc = context->protocol->get_info(context, &io);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100211 if (rc < 0) {
Andrew Jeffery1e531af2018-08-07 13:32:57 +0930212 return mbox_xlate_errno(context, rc);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100213 }
214
Andrew Jeffery1e531af2018-08-07 13:32:57 +0930215 resp->args[0] = io.resp.api_version;
216 if (io.resp.api_version == API_VERSION_1) {
217 put_u16(&resp->args[1], io.resp.v1.read_window_size);
218 put_u16(&resp->args[3], io.resp.v1.write_window_size);
219 } else if (io.resp.api_version >= API_VERSION_2) {
220 resp->args[5] = io.resp.v2.block_size_shift;
221 put_u16(&resp->args[6], io.resp.v2.timeout);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100222 }
223
224 return 0;
225}
226
227/*
228 * Command: GET_FLASH_INFO
229 * Get the flash size and erase granularity
230 *
231 * V1:
232 * RESP[0:3]: Flash Size (bytes)
233 * RESP[4:7]: Erase Size (bytes)
234 * V2:
235 * RESP[0:1]: Flash Size (number of blocks)
236 * RESP[2:3]: Erase Size (number of blocks)
237 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030238int mbox_handle_flash_info(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100239 union mbox_regs *req, struct mbox_msg *resp)
240{
Andrew Jeffery91a87452018-08-07 14:54:14 +0930241 struct protocol_get_flash_info io;
242 int rc;
243
244 rc = context->protocol->get_flash_info(context, &io);
245 if (rc < 0) {
246 return mbox_xlate_errno(context, rc);
247 }
248
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100249 switch (context->version) {
250 case API_VERSION_1:
251 /* Both Sizes in Bytes */
Andrew Jeffery91a87452018-08-07 14:54:14 +0930252 put_u32(&resp->args[0], io.resp.v1.flash_size);
253 put_u32(&resp->args[4], io.resp.v1.erase_size);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100254 break;
255 case API_VERSION_2:
256 /* Both Sizes in Block Size */
Andrew Jeffery91a87452018-08-07 14:54:14 +0930257 put_u16(&resp->args[0], io.resp.v2.flash_size);
258 put_u16(&resp->args[2], io.resp.v2.erase_size);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100259 break;
260 default:
261 MSG_ERR("API Version Not Valid - Invalid System State\n");
262 return -MBOX_R_SYSTEM_ERROR;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100263 }
264
265 return 0;
266}
267
268/*
269 * get_lpc_addr_shifted() - Get lpc address of the current window
270 * @context: The mbox context pointer
271 *
272 * Return: The lpc address to access that offset shifted by block size
273 */
274static inline uint16_t get_lpc_addr_shifted(struct mbox_context *context)
275{
276 uint32_t lpc_addr, mem_offset;
277
278 /* Offset of the current window in the reserved memory region */
279 mem_offset = context->current->mem - context->mem;
280 /* Total LPC Address */
281 lpc_addr = context->lpc_base + mem_offset;
282
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000283 MSG_DBG("LPC address of current window: 0x%.8x\n", lpc_addr);
284
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100285 return lpc_addr >> context->block_size_shift;
286}
287
Andrew Jeffery4bcec8e2018-08-07 15:33:41 +0930288int mbox_handle_create_window(struct mbox_context *context, bool ro,
289 union mbox_regs *req, struct mbox_msg *resp)
290{
291 struct protocol_create_window io;
292 int rc;
293
294 io.req.offset = get_u16(&req->msg.args[0]);
295 io.req.ro = ro;
296
297 rc = context->protocol->create_window(context, &io);
298 if (rc < 0) {
299 return rc;
300 }
301
302 put_u16(&resp->args[0], io.resp.lpc_address);
303 if (context->version >= API_VERSION_2) {
304 put_u16(&resp->args[2], io.resp.size);
305 put_u16(&resp->args[4], io.resp.offset);
306 }
307
308 return 0;
309}
310
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100311/*
312 * Command: CREATE_READ_WINDOW
313 * Opens a read window
314 * First checks if any current window with the requested data, if so we just
315 * point the host to that. Otherwise we read the request data in from flash and
316 * point the host there.
317 *
318 * V1:
319 * ARGS[0:1]: Window Location as Offset into Flash (number of blocks)
320 *
321 * RESP[0:1]: LPC bus address for host to access this window (number of blocks)
322 *
323 * V2:
324 * ARGS[0:1]: Window Location as Offset into Flash (number of blocks)
325 * ARGS[2:3]: Requested window size (number of blocks)
326 *
327 * RESP[0:1]: LPC bus address for host to access this window (number of blocks)
328 * RESP[2:3]: Actual window size that the host can access (number of blocks)
329 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030330int mbox_handle_read_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100331 union mbox_regs *req, struct mbox_msg *resp)
332{
Andrew Jeffery4bcec8e2018-08-07 15:33:41 +0930333 int rc = mbox_handle_create_window(context, true, req, resp);
Andrew Jeffery22fa5002018-08-07 15:22:50 +0930334 if (rc < 0) {
335 return mbox_xlate_errno(context, rc);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100336 }
337
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100338 return 0;
339}
340
341/*
342 * Command: CREATE_WRITE_WINDOW
343 * Opens a write window
344 * First checks if any current window with the requested data, if so we just
345 * point the host to that. Otherwise we read the request data in from flash and
346 * point the host there.
347 *
348 * V1:
349 * ARGS[0:1]: Window Location as Offset into Flash (number of blocks)
350 *
351 * RESP[0:1]: LPC bus address for host to access this window (number of blocks)
352 *
353 * V2:
354 * ARGS[0:1]: Window Location as Offset into Flash (number of blocks)
355 * ARGS[2:3]: Requested window size (number of blocks)
356 *
357 * RESP[0:1]: LPC bus address for host to access this window (number of blocks)
358 * RESP[2:3]: Actual window size that was mapped/host can access (n.o. blocks)
359 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030360int mbox_handle_write_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100361 union mbox_regs *req, struct mbox_msg *resp)
362{
Andrew Jeffery4bcec8e2018-08-07 15:33:41 +0930363 int rc = mbox_handle_create_window(context, false, req, resp);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100364 if (rc < 0) {
Andrew Jeffery4bcec8e2018-08-07 15:33:41 +0930365 return mbox_xlate_errno(context, rc);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100366 }
367
Andrew Jeffery4bcec8e2018-08-07 15:33:41 +0930368 return 0;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100369}
370
371/*
372 * Commands: MARK_WRITE_DIRTY
373 * Marks a portion of the current (write) window dirty, informing the daemon
374 * that is has been written to and thus must be at some point written to the
375 * backing store
376 * These changes aren't written back to the backing store unless flush is then
377 * called or the window closed
378 *
379 * V1:
380 * ARGS[0:1]: Where within flash to start (number of blocks)
381 * ARGS[2:5]: Number to mark dirty (number of bytes)
382 *
383 * V2:
384 * ARGS[0:1]: Where within window to start (number of blocks)
385 * ARGS[2:3]: Number to mark dirty (number of blocks)
386 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030387int mbox_handle_dirty_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100388 union mbox_regs *req, struct mbox_msg *resp)
389{
Andrew Jefferya336e432018-08-07 16:00:40 +0930390 struct protocol_mark_dirty io;
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930391 int rc;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100392
Andrew Jefferya336e432018-08-07 16:00:40 +0930393 if (context->version == API_VERSION_1) {
394 io.req.v1.offset = get_u16(&req->msg.args[0]);
395 io.req.v1.size = get_u32(&req->msg.args[2]);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100396 } else {
Andrew Jefferya336e432018-08-07 16:00:40 +0930397 io.req.v2.offset = get_u16(&req->msg.args[0]);
398 io.req.v2.size = get_u16(&req->msg.args[2]);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100399 }
400
Andrew Jefferya336e432018-08-07 16:00:40 +0930401 rc = context->protocol->mark_dirty(context, &io);
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930402 if (rc < 0) {
Andrew Jefferya336e432018-08-07 16:00:40 +0930403 return mbox_xlate_errno(context, rc);
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930404 }
405
406 return rc;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100407}
408
409/*
410 * Commands: MARK_WRITE_ERASE
411 * Erases a portion of the current window
412 * These changes aren't written back to the backing store unless flush is then
413 * called or the window closed
414 *
415 * V1:
416 * Unimplemented
417 *
418 * V2:
419 * ARGS[0:1]: Where within window to start (number of blocks)
420 * ARGS[2:3]: Number to erase (number of blocks)
421 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030422int mbox_handle_erase_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100423 union mbox_regs *req, struct mbox_msg *resp)
424{
425 uint32_t offset, size;
426 int rc;
427
428 if (context->version < API_VERSION_2) {
429 MSG_ERR("Protocol Version invalid for Erase Command\n");
430 return -MBOX_R_PARAM_ERROR;
431 }
432
433 if (!(context->current && context->current_is_write)) {
434 MSG_ERR("Tried to call erase without open write window\n");
435 return -MBOX_R_WINDOW_ERROR;
436 }
437
438 offset = get_u16(&req->msg.args[0]);
439 size = get_u16(&req->msg.args[2]);
440
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000441 MSG_INFO("Erase window @ 0x%.8x for 0x%.8x\n",
442 offset << context->block_size_shift,
443 size << context->block_size_shift);
444
Andrew Jeffery7d5ada62018-08-08 17:16:16 +0930445 rc = window_set_bytemap(context, context->current, offset, size,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100446 WINDOW_ERASED);
447 if (rc < 0) {
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930448 return (rc == -EACCES) ? -MBOX_R_PARAM_ERROR
449 : -MBOX_R_SYSTEM_ERROR;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100450 }
451
452 /* Write 0xFF to mem -> This ensures consistency between flash & ram */
453 memset(context->current->mem + (offset << context->block_size_shift),
454 0xFF, size << context->block_size_shift);
455
456 return 0;
457}
458
459/*
460 * Command: WRITE_FLUSH
461 * Flushes any dirty or erased blocks in the current window back to the backing
462 * store
463 * NOTE: For V1 this behaves much the same as the dirty command in that it
464 * takes an offset and number of blocks to dirty, then also performs a flush as
465 * part of the same command. For V2 this will only flush blocks already marked
466 * dirty/erased with the appropriate commands and doesn't take any arguments
467 * directly.
468 *
469 * V1:
470 * ARGS[0:1]: Where within window to start (number of blocks)
471 * ARGS[2:5]: Number to mark dirty (number of bytes)
472 *
473 * V2:
474 * NONE
475 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030476int mbox_handle_flush_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100477 union mbox_regs *req, struct mbox_msg *resp)
478{
479 int rc, i, offset, count;
480 uint8_t prev;
481
482 if (!(context->current && context->current_is_write)) {
483 MSG_ERR("Tried to call flush without open write window\n");
484 return context->version >= API_VERSION_2 ? -MBOX_R_WINDOW_ERROR
485 : -MBOX_R_PARAM_ERROR;
486 }
487
488 /*
489 * For V1 the Flush command acts much the same as the dirty command
490 * except with a flush as well. Only do this on an actual flush
491 * command not when we call flush because we've implicitly closed a
492 * window because we might not have the required args in req.
493 */
494 if (context->version == API_VERSION_1 && req &&
495 req->msg.command == MBOX_C_WRITE_FLUSH) {
496 rc = mbox_handle_dirty_window(context, req, NULL);
497 if (rc < 0) {
498 return rc;
499 }
500 }
501
502 offset = 0;
503 count = 0;
504 prev = WINDOW_CLEAN;
505
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000506 MSG_INFO("Flush window @ %p for size 0x%.8x which maps flash @ 0x%.8x\n",
507 context->current->mem, context->current->size,
508 context->current->flash_offset);
509
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100510 /*
511 * We look for streaks of the same type and keep a count, when the type
512 * (dirty/erased) changes we perform the required action on the backing
513 * store and update the current streak-type
514 */
515 for (i = 0; i < (context->current->size >> context->block_size_shift);
516 i++) {
517 uint8_t cur = context->current->dirty_bmap[i];
518 if (cur != WINDOW_CLEAN) {
519 if (cur == prev) { /* Same as previous block, incrmnt */
520 count++;
521 } else if (prev == WINDOW_CLEAN) { /* Start of run */
522 offset = i;
523 count++;
524 } else { /* Change in streak type */
Andrew Jeffery3200c072018-08-08 17:12:03 +0930525 rc = window_flush(context, offset, count,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100526 prev);
527 if (rc < 0) {
528 return rc;
529 }
530 offset = i;
531 count = 1;
532 }
533 } else {
534 if (prev != WINDOW_CLEAN) { /* End of a streak */
Andrew Jeffery3200c072018-08-08 17:12:03 +0930535 rc = window_flush(context, offset, count,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100536 prev);
537 if (rc < 0) {
538 return rc;
539 }
540 offset = 0;
541 count = 0;
542 }
543 }
544 prev = cur;
545 }
546
547 if (prev != WINDOW_CLEAN) { /* Still the last streak to write */
Andrew Jeffery3200c072018-08-08 17:12:03 +0930548 rc = window_flush(context, offset, count, prev);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100549 if (rc < 0) {
550 return rc;
551 }
552 }
553
554 /* Clear the dirty bytemap since we have written back all changes */
Andrew Jeffery7d5ada62018-08-08 17:16:16 +0930555 rc = window_set_bytemap(context, context->current, 0,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100556 context->current->size >>
557 context->block_size_shift,
558 WINDOW_CLEAN);
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930559 if (rc < 0) {
560 return (rc == -EACCES) ? -MBOX_R_PARAM_ERROR
561 : -MBOX_R_SYSTEM_ERROR;
562 }
563
564 return rc;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100565}
566
567/*
568 * Command: CLOSE_WINDOW
569 * Close the current window
570 * NOTE: There is an implicit flush
571 *
572 * V1:
573 * NONE
574 *
575 * V2:
576 * ARGS[0]: FLAGS
577 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030578int mbox_handle_close_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100579 union mbox_regs *req, struct mbox_msg *resp)
580{
581 uint8_t flags = 0;
582 int rc;
583
584 /* Close the current window if there is one */
585 if (context->current) {
586 /* There is an implicit flush if it was a write window */
587 if (context->current_is_write) {
588 rc = mbox_handle_flush_window(context, NULL, NULL);
589 if (rc < 0) {
590 MSG_ERR("Couldn't Flush Write Window\n");
591 return rc;
592 }
593 }
594
595 if (context->version >= API_VERSION_2) {
596 flags = req->msg.args[0];
597 }
598
599 /* Host asked for it -> Don't set the BMC Event */
Andrew Jefferyb65bb4c2018-08-08 17:18:24 +0930600 windows_close_current(context, NO_BMC_EVENT, flags);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100601 }
602
603 return 0;
604}
605
606/*
607 * Command: BMC_EVENT_ACK
608 * Sent by the host to acknowledge BMC events supplied in mailbox register 15
609 *
610 * ARGS[0]: Bitmap of bits to ack (by clearing)
611 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030612int mbox_handle_ack(struct mbox_context *context, union mbox_regs *req,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100613 struct mbox_msg *resp)
614{
615 uint8_t bmc_events = req->msg.args[0];
616
617 return clr_bmc_events(context, (bmc_events & BMC_EVENT_ACK_MASK),
618 SET_BMC_EVENT);
619}
620
621/*
Andrew Jeffery55dede62017-04-24 16:13:06 +0930622 * check_req_valid() - Check if the given request is a valid mbox request
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100623 * @context: The mbox context pointer
Andrew Jeffery55dede62017-04-24 16:13:06 +0930624 * @cmd: The request registers
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100625 *
Andrew Jeffery55dede62017-04-24 16:13:06 +0930626 * Return: 0 if request is valid otherwise negative error code
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100627 */
Andrew Jeffery55dede62017-04-24 16:13:06 +0930628static int check_req_valid(struct mbox_context *context, union mbox_regs *req)
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100629{
Andrew Jeffery55dede62017-04-24 16:13:06 +0930630 uint8_t cmd = req->msg.command;
631 uint8_t seq = req->msg.seq;
632
633 if (cmd > NUM_MBOX_CMDS) {
Andrew Jeffery121dc0d2017-04-24 16:15:06 +0930634 MSG_ERR("Unknown mbox command: %d\n", cmd);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100635 return -MBOX_R_PARAM_ERROR;
636 }
Andrew Jeffery121dc0d2017-04-24 16:15:06 +0930637
Andrew Jeffery55dede62017-04-24 16:13:06 +0930638 if (seq == context->prev_seq && cmd != MBOX_C_GET_MBOX_INFO) {
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000639 MSG_ERR("Invalid sequence number: %d, previous: %d\n", seq,
640 context->prev_seq);
Andrew Jeffery55dede62017-04-24 16:13:06 +0930641 return -MBOX_R_SEQ_ERROR;
642 }
643
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100644 if (context->state & STATE_SUSPENDED) {
645 if (cmd != MBOX_C_GET_MBOX_INFO && cmd != MBOX_C_ACK) {
646 MSG_ERR("Cannot use that cmd while suspended: %d\n",
647 cmd);
648 return context->version >= API_VERSION_2 ? -MBOX_R_BUSY
649 : -MBOX_R_PARAM_ERROR;
650 }
651 }
Andrew Jeffery121dc0d2017-04-24 16:15:06 +0930652
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100653 if (!(context->state & MAPS_MEM)) {
654 if (cmd != MBOX_C_RESET_STATE && cmd != MBOX_C_GET_MBOX_INFO
655 && cmd != MBOX_C_ACK) {
Andrew Jeffery121dc0d2017-04-24 16:15:06 +0930656 MSG_ERR("Must call GET_MBOX_INFO before %d\n", cmd);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100657 return -MBOX_R_PARAM_ERROR;
658 }
659 }
660
661 return 0;
662}
663
664static const mboxd_mbox_handler mbox_handlers[] = {
665 mbox_handle_reset,
666 mbox_handle_mbox_info,
667 mbox_handle_flash_info,
668 mbox_handle_read_window,
669 mbox_handle_close_window,
670 mbox_handle_write_window,
671 mbox_handle_dirty_window,
672 mbox_handle_flush_window,
673 mbox_handle_ack,
674 mbox_handle_erase_window
675};
676
677/*
678 * handle_mbox_req() - Handle an incoming mbox command request
679 * @context: The mbox context pointer
680 * @req: The mbox request message
681 *
682 * Return: 0 if handled successfully otherwise negative error code
683 */
684static int handle_mbox_req(struct mbox_context *context, union mbox_regs *req)
685{
686 struct mbox_msg resp = {
687 .command = req->msg.command,
688 .seq = req->msg.seq,
689 .args = { 0 },
690 .response = MBOX_R_SUCCESS
691 };
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000692 int rc = 0, len, i;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100693
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000694 MSG_INFO("Received MBOX command: %u\n", req->msg.command);
Andrew Jeffery55dede62017-04-24 16:13:06 +0930695 rc = check_req_valid(context, req);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100696 if (rc < 0) {
697 resp.response = -rc;
698 } else {
699 /* Commands start at 1 so we have to subtract 1 from the cmd */
Andrew Jefferyefb09de2018-03-26 14:36:43 +1030700 mboxd_mbox_handler h = context->handlers[req->msg.command - 1];
701 rc = h(context, req, &resp);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100702 if (rc < 0) {
703 MSG_ERR("Error handling mbox cmd: %d\n",
704 req->msg.command);
705 resp.response = -rc;
706 }
707 }
708
Andrew Jeffery55dede62017-04-24 16:13:06 +0930709 context->prev_seq = req->msg.seq;
710
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000711 MSG_DBG("Writing MBOX response:\n");
712 MSG_DBG("MBOX cmd: %u\n", resp.command);
713 MSG_DBG("MBOX seq: %u\n", resp.seq);
714 for (i = 0; i < MBOX_ARGS_BYTES; i++) {
715 MSG_DBG("MBOX arg[%d]: 0x%.2x\n", i, resp.args[i]);
716 }
717 MSG_INFO("Writing MBOX response: %u\n", resp.response);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100718 len = write(context->fds[MBOX_FD].fd, &resp, sizeof(resp));
719 if (len < sizeof(resp)) {
720 MSG_ERR("Didn't write the full response\n");
721 rc = -errno;
722 }
723
724 return rc;
725}
726
727/*
728 * get_message() - Read an mbox request message from the mbox registers
729 * @context: The mbox context pointer
730 * @msg: Where to put the received message
731 *
732 * Return: 0 if read successfully otherwise negative error code
733 */
734static int get_message(struct mbox_context *context, union mbox_regs *msg)
735{
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000736 int rc, i;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100737
738 rc = read(context->fds[MBOX_FD].fd, msg, sizeof(msg->raw));
739 if (rc < 0) {
740 MSG_ERR("Couldn't read: %s\n", strerror(errno));
741 return -errno;
742 } else if (rc < sizeof(msg->raw)) {
743 MSG_ERR("Short read: %d expecting %zu\n", rc, sizeof(msg->raw));
744 return -1;
745 }
746
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000747 MSG_DBG("Received MBOX request:\n");
748 MSG_DBG("MBOX cmd: %u\n", msg->msg.command);
749 MSG_DBG("MBOX seq: %u\n", msg->msg.seq);
750 for (i = 0; i < MBOX_ARGS_BYTES; i++) {
751 MSG_DBG("MBOX arg[%d]: 0x%.2x\n", i, msg->msg.args[i]);
752 }
753
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100754 return 0;
755}
756
757/*
758 * dispatch_mbox() - handle an mbox interrupt
759 * @context: The mbox context pointer
760 *
761 * Return: 0 if handled successfully otherwise negative error code
762 */
763int dispatch_mbox(struct mbox_context *context)
764{
765 int rc = 0;
766 union mbox_regs req = { 0 };
767
768 assert(context);
769
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100770 rc = get_message(context, &req);
771 if (rc) {
772 return rc;
773 }
774
775 return handle_mbox_req(context, &req);
776}
777
Andrew Jeffery913740f2017-04-10 23:51:07 +0930778int __init_mbox_dev(struct mbox_context *context, const char *path)
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100779{
780 int fd;
781
Andrew Jefferyefb09de2018-03-26 14:36:43 +1030782 context->handlers = mbox_handlers;
783
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100784 /* Open MBOX Device */
Andrew Jeffery913740f2017-04-10 23:51:07 +0930785 fd = open(path, O_RDWR | O_NONBLOCK);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100786 if (fd < 0) {
787 MSG_ERR("Couldn't open %s with flags O_RDWR: %s\n",
Andrew Jeffery913740f2017-04-10 23:51:07 +0930788 path, strerror(errno));
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100789 return -errno;
790 }
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000791 MSG_DBG("Opened mbox dev: %s\n", path);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100792
793 context->fds[MBOX_FD].fd = fd;
794
795 return 0;
796}
797
Andrew Jeffery913740f2017-04-10 23:51:07 +0930798int init_mbox_dev(struct mbox_context *context)
799{
800 return __init_mbox_dev(context, MBOX_HOST_PATH);
801}
802
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100803void free_mbox_dev(struct mbox_context *context)
804{
805 close(context->fds[MBOX_FD].fd);
806}