blob: 8ea400c169d0e6a72d6f9cb39fa25a5822e42560 [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{
390 uint32_t offset, size;
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930391 int rc;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100392
393 if (!(context->current && context->current_is_write)) {
394 MSG_ERR("Tried to call mark dirty without open write window\n");
395 return context->version >= API_VERSION_2 ? -MBOX_R_WINDOW_ERROR
396 : -MBOX_R_PARAM_ERROR;
397 }
398
399 offset = get_u16(&req->msg.args[0]);
400
401 if (context->version >= API_VERSION_2) {
402 size = get_u16(&req->msg.args[2]);
403 } else {
404 uint32_t off;
405 /* For V1 offset given relative to flash - we want the window */
406 off = offset - ((context->current->flash_offset) >>
407 context->block_size_shift);
408 if (off > offset) { /* Underflow - before current window */
409 MSG_ERR("Tried to mark dirty before start of window\n");
410 MSG_ERR("requested offset: 0x%x window start: 0x%x\n",
411 offset << context->block_size_shift,
412 context->current->flash_offset);
413 return -MBOX_R_PARAM_ERROR;
414 }
415 offset = off;
416 size = get_u32(&req->msg.args[2]);
417 /*
418 * We only track dirty at the block level.
419 * For protocol V1 we can get away with just marking the whole
420 * block dirty.
421 */
422 size = align_up(size, 1 << context->block_size_shift);
423 size >>= context->block_size_shift;
424 }
425
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000426 MSG_INFO("Dirty window @ 0x%.8x for 0x%.8x\n",
427 offset << context->block_size_shift,
428 size << context->block_size_shift);
429
Andrew Jeffery7d5ada62018-08-08 17:16:16 +0930430 rc = window_set_bytemap(context, context->current, offset, size,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100431 WINDOW_DIRTY);
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930432 if (rc < 0) {
433 return (rc == -EACCES) ? -MBOX_R_PARAM_ERROR
434 : -MBOX_R_SYSTEM_ERROR;
435 }
436
437 return rc;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100438}
439
440/*
441 * Commands: MARK_WRITE_ERASE
442 * Erases a portion of the current window
443 * These changes aren't written back to the backing store unless flush is then
444 * called or the window closed
445 *
446 * V1:
447 * Unimplemented
448 *
449 * V2:
450 * ARGS[0:1]: Where within window to start (number of blocks)
451 * ARGS[2:3]: Number to erase (number of blocks)
452 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030453int mbox_handle_erase_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100454 union mbox_regs *req, struct mbox_msg *resp)
455{
456 uint32_t offset, size;
457 int rc;
458
459 if (context->version < API_VERSION_2) {
460 MSG_ERR("Protocol Version invalid for Erase Command\n");
461 return -MBOX_R_PARAM_ERROR;
462 }
463
464 if (!(context->current && context->current_is_write)) {
465 MSG_ERR("Tried to call erase without open write window\n");
466 return -MBOX_R_WINDOW_ERROR;
467 }
468
469 offset = get_u16(&req->msg.args[0]);
470 size = get_u16(&req->msg.args[2]);
471
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000472 MSG_INFO("Erase window @ 0x%.8x for 0x%.8x\n",
473 offset << context->block_size_shift,
474 size << context->block_size_shift);
475
Andrew Jeffery7d5ada62018-08-08 17:16:16 +0930476 rc = window_set_bytemap(context, context->current, offset, size,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100477 WINDOW_ERASED);
478 if (rc < 0) {
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930479 return (rc == -EACCES) ? -MBOX_R_PARAM_ERROR
480 : -MBOX_R_SYSTEM_ERROR;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100481 }
482
483 /* Write 0xFF to mem -> This ensures consistency between flash & ram */
484 memset(context->current->mem + (offset << context->block_size_shift),
485 0xFF, size << context->block_size_shift);
486
487 return 0;
488}
489
490/*
491 * Command: WRITE_FLUSH
492 * Flushes any dirty or erased blocks in the current window back to the backing
493 * store
494 * NOTE: For V1 this behaves much the same as the dirty command in that it
495 * takes an offset and number of blocks to dirty, then also performs a flush as
496 * part of the same command. For V2 this will only flush blocks already marked
497 * dirty/erased with the appropriate commands and doesn't take any arguments
498 * directly.
499 *
500 * V1:
501 * ARGS[0:1]: Where within window to start (number of blocks)
502 * ARGS[2:5]: Number to mark dirty (number of bytes)
503 *
504 * V2:
505 * NONE
506 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030507int mbox_handle_flush_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100508 union mbox_regs *req, struct mbox_msg *resp)
509{
510 int rc, i, offset, count;
511 uint8_t prev;
512
513 if (!(context->current && context->current_is_write)) {
514 MSG_ERR("Tried to call flush without open write window\n");
515 return context->version >= API_VERSION_2 ? -MBOX_R_WINDOW_ERROR
516 : -MBOX_R_PARAM_ERROR;
517 }
518
519 /*
520 * For V1 the Flush command acts much the same as the dirty command
521 * except with a flush as well. Only do this on an actual flush
522 * command not when we call flush because we've implicitly closed a
523 * window because we might not have the required args in req.
524 */
525 if (context->version == API_VERSION_1 && req &&
526 req->msg.command == MBOX_C_WRITE_FLUSH) {
527 rc = mbox_handle_dirty_window(context, req, NULL);
528 if (rc < 0) {
529 return rc;
530 }
531 }
532
533 offset = 0;
534 count = 0;
535 prev = WINDOW_CLEAN;
536
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000537 MSG_INFO("Flush window @ %p for size 0x%.8x which maps flash @ 0x%.8x\n",
538 context->current->mem, context->current->size,
539 context->current->flash_offset);
540
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100541 /*
542 * We look for streaks of the same type and keep a count, when the type
543 * (dirty/erased) changes we perform the required action on the backing
544 * store and update the current streak-type
545 */
546 for (i = 0; i < (context->current->size >> context->block_size_shift);
547 i++) {
548 uint8_t cur = context->current->dirty_bmap[i];
549 if (cur != WINDOW_CLEAN) {
550 if (cur == prev) { /* Same as previous block, incrmnt */
551 count++;
552 } else if (prev == WINDOW_CLEAN) { /* Start of run */
553 offset = i;
554 count++;
555 } else { /* Change in streak type */
Andrew Jeffery3200c072018-08-08 17:12:03 +0930556 rc = window_flush(context, offset, count,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100557 prev);
558 if (rc < 0) {
559 return rc;
560 }
561 offset = i;
562 count = 1;
563 }
564 } else {
565 if (prev != WINDOW_CLEAN) { /* End of a streak */
Andrew Jeffery3200c072018-08-08 17:12:03 +0930566 rc = window_flush(context, offset, count,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100567 prev);
568 if (rc < 0) {
569 return rc;
570 }
571 offset = 0;
572 count = 0;
573 }
574 }
575 prev = cur;
576 }
577
578 if (prev != WINDOW_CLEAN) { /* Still the last streak to write */
Andrew Jeffery3200c072018-08-08 17:12:03 +0930579 rc = window_flush(context, offset, count, prev);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100580 if (rc < 0) {
581 return rc;
582 }
583 }
584
585 /* Clear the dirty bytemap since we have written back all changes */
Andrew Jeffery7d5ada62018-08-08 17:16:16 +0930586 rc = window_set_bytemap(context, context->current, 0,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100587 context->current->size >>
588 context->block_size_shift,
589 WINDOW_CLEAN);
Andrew Jeffery6a0e2de2018-08-07 22:31:00 +0930590 if (rc < 0) {
591 return (rc == -EACCES) ? -MBOX_R_PARAM_ERROR
592 : -MBOX_R_SYSTEM_ERROR;
593 }
594
595 return rc;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100596}
597
598/*
599 * Command: CLOSE_WINDOW
600 * Close the current window
601 * NOTE: There is an implicit flush
602 *
603 * V1:
604 * NONE
605 *
606 * V2:
607 * ARGS[0]: FLAGS
608 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030609int mbox_handle_close_window(struct mbox_context *context,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100610 union mbox_regs *req, struct mbox_msg *resp)
611{
612 uint8_t flags = 0;
613 int rc;
614
615 /* Close the current window if there is one */
616 if (context->current) {
617 /* There is an implicit flush if it was a write window */
618 if (context->current_is_write) {
619 rc = mbox_handle_flush_window(context, NULL, NULL);
620 if (rc < 0) {
621 MSG_ERR("Couldn't Flush Write Window\n");
622 return rc;
623 }
624 }
625
626 if (context->version >= API_VERSION_2) {
627 flags = req->msg.args[0];
628 }
629
630 /* Host asked for it -> Don't set the BMC Event */
Andrew Jefferyb65bb4c2018-08-08 17:18:24 +0930631 windows_close_current(context, NO_BMC_EVENT, flags);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100632 }
633
634 return 0;
635}
636
637/*
638 * Command: BMC_EVENT_ACK
639 * Sent by the host to acknowledge BMC events supplied in mailbox register 15
640 *
641 * ARGS[0]: Bitmap of bits to ack (by clearing)
642 */
Andrew Jeffery943aba02018-03-26 15:37:33 +1030643int mbox_handle_ack(struct mbox_context *context, union mbox_regs *req,
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100644 struct mbox_msg *resp)
645{
646 uint8_t bmc_events = req->msg.args[0];
647
648 return clr_bmc_events(context, (bmc_events & BMC_EVENT_ACK_MASK),
649 SET_BMC_EVENT);
650}
651
652/*
Andrew Jeffery55dede62017-04-24 16:13:06 +0930653 * check_req_valid() - Check if the given request is a valid mbox request
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100654 * @context: The mbox context pointer
Andrew Jeffery55dede62017-04-24 16:13:06 +0930655 * @cmd: The request registers
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100656 *
Andrew Jeffery55dede62017-04-24 16:13:06 +0930657 * Return: 0 if request is valid otherwise negative error code
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100658 */
Andrew Jeffery55dede62017-04-24 16:13:06 +0930659static int check_req_valid(struct mbox_context *context, union mbox_regs *req)
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100660{
Andrew Jeffery55dede62017-04-24 16:13:06 +0930661 uint8_t cmd = req->msg.command;
662 uint8_t seq = req->msg.seq;
663
664 if (cmd > NUM_MBOX_CMDS) {
Andrew Jeffery121dc0d2017-04-24 16:15:06 +0930665 MSG_ERR("Unknown mbox command: %d\n", cmd);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100666 return -MBOX_R_PARAM_ERROR;
667 }
Andrew Jeffery121dc0d2017-04-24 16:15:06 +0930668
Andrew Jeffery55dede62017-04-24 16:13:06 +0930669 if (seq == context->prev_seq && cmd != MBOX_C_GET_MBOX_INFO) {
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000670 MSG_ERR("Invalid sequence number: %d, previous: %d\n", seq,
671 context->prev_seq);
Andrew Jeffery55dede62017-04-24 16:13:06 +0930672 return -MBOX_R_SEQ_ERROR;
673 }
674
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100675 if (context->state & STATE_SUSPENDED) {
676 if (cmd != MBOX_C_GET_MBOX_INFO && cmd != MBOX_C_ACK) {
677 MSG_ERR("Cannot use that cmd while suspended: %d\n",
678 cmd);
679 return context->version >= API_VERSION_2 ? -MBOX_R_BUSY
680 : -MBOX_R_PARAM_ERROR;
681 }
682 }
Andrew Jeffery121dc0d2017-04-24 16:15:06 +0930683
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100684 if (!(context->state & MAPS_MEM)) {
685 if (cmd != MBOX_C_RESET_STATE && cmd != MBOX_C_GET_MBOX_INFO
686 && cmd != MBOX_C_ACK) {
Andrew Jeffery121dc0d2017-04-24 16:15:06 +0930687 MSG_ERR("Must call GET_MBOX_INFO before %d\n", cmd);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100688 return -MBOX_R_PARAM_ERROR;
689 }
690 }
691
692 return 0;
693}
694
695static const mboxd_mbox_handler mbox_handlers[] = {
696 mbox_handle_reset,
697 mbox_handle_mbox_info,
698 mbox_handle_flash_info,
699 mbox_handle_read_window,
700 mbox_handle_close_window,
701 mbox_handle_write_window,
702 mbox_handle_dirty_window,
703 mbox_handle_flush_window,
704 mbox_handle_ack,
705 mbox_handle_erase_window
706};
707
708/*
709 * handle_mbox_req() - Handle an incoming mbox command request
710 * @context: The mbox context pointer
711 * @req: The mbox request message
712 *
713 * Return: 0 if handled successfully otherwise negative error code
714 */
715static int handle_mbox_req(struct mbox_context *context, union mbox_regs *req)
716{
717 struct mbox_msg resp = {
718 .command = req->msg.command,
719 .seq = req->msg.seq,
720 .args = { 0 },
721 .response = MBOX_R_SUCCESS
722 };
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000723 int rc = 0, len, i;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100724
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000725 MSG_INFO("Received MBOX command: %u\n", req->msg.command);
Andrew Jeffery55dede62017-04-24 16:13:06 +0930726 rc = check_req_valid(context, req);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100727 if (rc < 0) {
728 resp.response = -rc;
729 } else {
730 /* Commands start at 1 so we have to subtract 1 from the cmd */
Andrew Jefferyefb09de2018-03-26 14:36:43 +1030731 mboxd_mbox_handler h = context->handlers[req->msg.command - 1];
732 rc = h(context, req, &resp);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100733 if (rc < 0) {
734 MSG_ERR("Error handling mbox cmd: %d\n",
735 req->msg.command);
736 resp.response = -rc;
737 }
738 }
739
Andrew Jeffery55dede62017-04-24 16:13:06 +0930740 context->prev_seq = req->msg.seq;
741
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000742 MSG_DBG("Writing MBOX response:\n");
743 MSG_DBG("MBOX cmd: %u\n", resp.command);
744 MSG_DBG("MBOX seq: %u\n", resp.seq);
745 for (i = 0; i < MBOX_ARGS_BYTES; i++) {
746 MSG_DBG("MBOX arg[%d]: 0x%.2x\n", i, resp.args[i]);
747 }
748 MSG_INFO("Writing MBOX response: %u\n", resp.response);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100749 len = write(context->fds[MBOX_FD].fd, &resp, sizeof(resp));
750 if (len < sizeof(resp)) {
751 MSG_ERR("Didn't write the full response\n");
752 rc = -errno;
753 }
754
755 return rc;
756}
757
758/*
759 * get_message() - Read an mbox request message from the mbox registers
760 * @context: The mbox context pointer
761 * @msg: Where to put the received message
762 *
763 * Return: 0 if read successfully otherwise negative error code
764 */
765static int get_message(struct mbox_context *context, union mbox_regs *msg)
766{
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000767 int rc, i;
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100768
769 rc = read(context->fds[MBOX_FD].fd, msg, sizeof(msg->raw));
770 if (rc < 0) {
771 MSG_ERR("Couldn't read: %s\n", strerror(errno));
772 return -errno;
773 } else if (rc < sizeof(msg->raw)) {
774 MSG_ERR("Short read: %d expecting %zu\n", rc, sizeof(msg->raw));
775 return -1;
776 }
777
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000778 MSG_DBG("Received MBOX request:\n");
779 MSG_DBG("MBOX cmd: %u\n", msg->msg.command);
780 MSG_DBG("MBOX seq: %u\n", msg->msg.seq);
781 for (i = 0; i < MBOX_ARGS_BYTES; i++) {
782 MSG_DBG("MBOX arg[%d]: 0x%.2x\n", i, msg->msg.args[i]);
783 }
784
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100785 return 0;
786}
787
788/*
789 * dispatch_mbox() - handle an mbox interrupt
790 * @context: The mbox context pointer
791 *
792 * Return: 0 if handled successfully otherwise negative error code
793 */
794int dispatch_mbox(struct mbox_context *context)
795{
796 int rc = 0;
797 union mbox_regs req = { 0 };
798
799 assert(context);
800
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100801 rc = get_message(context, &req);
802 if (rc) {
803 return rc;
804 }
805
806 return handle_mbox_req(context, &req);
807}
808
Andrew Jeffery913740f2017-04-10 23:51:07 +0930809int __init_mbox_dev(struct mbox_context *context, const char *path)
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100810{
811 int fd;
812
Andrew Jefferyefb09de2018-03-26 14:36:43 +1030813 context->handlers = mbox_handlers;
814
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100815 /* Open MBOX Device */
Andrew Jeffery913740f2017-04-10 23:51:07 +0930816 fd = open(path, O_RDWR | O_NONBLOCK);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100817 if (fd < 0) {
818 MSG_ERR("Couldn't open %s with flags O_RDWR: %s\n",
Andrew Jeffery913740f2017-04-10 23:51:07 +0930819 path, strerror(errno));
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100820 return -errno;
821 }
Suraj Jitindar Singh28519592017-04-27 14:48:58 +1000822 MSG_DBG("Opened mbox dev: %s\n", path);
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100823
824 context->fds[MBOX_FD].fd = fd;
825
826 return 0;
827}
828
Andrew Jeffery913740f2017-04-10 23:51:07 +0930829int init_mbox_dev(struct mbox_context *context)
830{
831 return __init_mbox_dev(context, MBOX_HOST_PATH);
832}
833
Suraj Jitindar Singhe39c9162017-03-28 10:47:43 +1100834void free_mbox_dev(struct mbox_context *context)
835{
836 close(context->fds[MBOX_FD].fd);
837}