Angel Pons | c74dae9 | 2020-04-02 23:48:16 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Julius Werner | db7f6fb | 2019-08-12 16:45:21 -0700 | [diff] [blame] | 2 | |
| 3 | #include <assert.h> |
Elyes Haouas | 04c3b5a | 2022-10-07 10:08:05 +0200 | [diff] [blame] | 4 | #include <commonlib/bsd/helpers.h> |
Julius Werner | db7f6fb | 2019-08-12 16:45:21 -0700 | [diff] [blame] | 5 | #include <device/mmio.h> |
Elyes Haouas | 04c3b5a | 2022-10-07 10:08:05 +0200 | [diff] [blame] | 6 | #include <types.h> |
Julius Werner | db7f6fb | 2019-08-12 16:45:21 -0700 | [diff] [blame] | 7 | |
| 8 | /* Helper functions for various MMIO access patterns. */ |
| 9 | |
| 10 | void buffer_from_fifo32(void *buffer, size_t size, void *fifo, |
| 11 | int fifo_stride, int fifo_width) |
| 12 | { |
| 13 | u8 *p = buffer; |
| 14 | int i, j; |
| 15 | |
| 16 | assert(fifo_width > 0 && fifo_width <= sizeof(u32) && |
| 17 | fifo_stride % sizeof(u32) == 0); |
| 18 | |
| 19 | for (i = 0; i < size; i += fifo_width, fifo += fifo_stride) { |
| 20 | u32 val = read32(fifo); |
| 21 | for (j = 0; j < MIN(size - i, fifo_width); j++) |
| 22 | *p++ = (u8)(val >> (j * 8)); |
| 23 | } |
| 24 | } |
| 25 | |
Julius Werner | ea03d00 | 2021-09-16 15:53:32 -0700 | [diff] [blame] | 26 | void buffer_to_fifo32_prefix(const void *buffer, u32 prefix, int prefsz, size_t size, |
Julius Werner | db7f6fb | 2019-08-12 16:45:21 -0700 | [diff] [blame] | 27 | void *fifo, int fifo_stride, int fifo_width) |
| 28 | { |
Julius Werner | ea03d00 | 2021-09-16 15:53:32 -0700 | [diff] [blame] | 29 | const u8 *p = buffer; |
Julius Werner | db7f6fb | 2019-08-12 16:45:21 -0700 | [diff] [blame] | 30 | int i, j = prefsz; |
| 31 | |
| 32 | assert(fifo_width > 0 && fifo_width <= sizeof(u32) && |
| 33 | fifo_stride % sizeof(u32) == 0 && prefsz <= fifo_width); |
| 34 | |
| 35 | uint32_t val = prefix; |
| 36 | for (i = 0; i < size; i += fifo_width, fifo += fifo_stride) { |
| 37 | for (; j < MIN(size - i, fifo_width); j++) |
| 38 | val |= *p++ << (j * 8); |
| 39 | write32(fifo, val); |
| 40 | val = 0; |
| 41 | j = 0; |
| 42 | } |
Julius Werner | db7f6fb | 2019-08-12 16:45:21 -0700 | [diff] [blame] | 43 | } |