diff options
Diffstat (limited to 'src/stream/rom_stream.c')
-rw-r--r-- | src/stream/rom_stream.c | 58 |
1 files changed, 58 insertions, 0 deletions
diff --git a/src/stream/rom_stream.c b/src/stream/rom_stream.c new file mode 100644 index 0000000000..20b7686c84 --- /dev/null +++ b/src/stream/rom_stream.c @@ -0,0 +1,58 @@ +#include <console/console.h> +#include <stdlib.h> +#include <stddef.h> +#include <stream/read_bytes.h> +#include <string.h> + + +#ifndef CONFIG_ROM_STREAM_START +#define CONFIG_ROM_STREAM_START 0xffff0000UL +#endif + +static const unsigned char *rom_start = (void *)CONFIG_ROM_STREAM_START; +static const unsigned char *rom_end = (void *)(CONFIG_ROM_STREAM_START + PAYLOAD_SIZE - 1); +static const unsigned char *rom; + +int stream_init(void) +{ + rom = rom_start; + + printk_spew("%6d:%s() - rom_stream: 0x%08lx - 0x%08lx\n" + __LINE__, __FUNCTION__, + (unsigned long)rom_start, + (unsigned long)rom_end); + return 0; +} + + +void stream_fini(void) +{ + return; +} + +byte_offset_t stream_skip(byte_offset_t count) +{ + byte_offset_t bytes; + bytes = count; + if ((rom + bytes) > rom_end) { + printk_warning("%6d:%s() - overflowed source buffer\n", + __LINE__, __FUNCTION__); + bytes = 0; + if (rom <= rom_end) { + bytes = (rom_end - rom) + 1; + } + } + rom += bytes; + return bytes; +} + +byte_offset_t stream_read(void *vdest, byte_offset_t count) +{ + unsigned char *dest = vdest; + const unsigned char *src = rom; + byte_offset_t bytes; + + bytes = stream_skip(count); + memcpy(dest, src, bytes); + return bytes; +} |