Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 | // SPDX-License-Identifier: GPL-2.0 /* * Copyright (C) STMicroelectronics SA 2013 * Author: Hugues Fruchet <hugues.fruchet@st.com> for STMicroelectronics. */ #include "delta.h" #include "delta-mjpeg.h" #define MJPEG_SOF_0 0xc0 #define MJPEG_SOF_1 0xc1 #define MJPEG_SOI 0xd8 #define MJPEG_MARKER 0xff static char *header_str(struct mjpeg_header *header, char *str, unsigned int len) { char *cur = str; unsigned int left = len; if (!header) return ""; snprintf(cur, left, "[MJPEG header]\n" "|- length = %d\n" "|- precision = %d\n" "|- width = %d\n" "|- height = %d\n" "|- components = %d\n", header->length, header->sample_precision, header->frame_width, header->frame_height, header->nb_of_components); return str; } static int delta_mjpeg_read_sof(struct delta_ctx *pctx, unsigned char *data, unsigned int size, struct mjpeg_header *header) { struct delta_dev *delta = pctx->dev; unsigned int offset = 0; if (size < 64) goto err_no_more; memset(header, 0, sizeof(*header)); header->length = be16_to_cpu(*(__be16 *)(data + offset)); offset += sizeof(u16); header->sample_precision = *(u8 *)(data + offset); offset += sizeof(u8); header->frame_height = be16_to_cpu(*(__be16 *)(data + offset)); offset += sizeof(u16); header->frame_width = be16_to_cpu(*(__be16 *)(data + offset)); offset += sizeof(u16); header->nb_of_components = *(u8 *)(data + offset); offset += sizeof(u8); if (header->nb_of_components >= MJPEG_MAX_COMPONENTS) { dev_err(delta->dev, "%s unsupported number of components (%d > %d)\n", pctx->name, header->nb_of_components, MJPEG_MAX_COMPONENTS); return -EINVAL; } if ((offset + header->nb_of_components * sizeof(header->components[0])) > size) goto err_no_more; return 0; err_no_more: dev_err(delta->dev, "%s sof: reached end of %d size input stream\n", pctx->name, size); return -ENODATA; } int delta_mjpeg_read_header(struct delta_ctx *pctx, unsigned char *data, unsigned int size, struct mjpeg_header *header, unsigned int *data_offset) { struct delta_dev *delta = pctx->dev; unsigned char str[200]; unsigned int ret = 0; unsigned int offset = 0; unsigned int soi = 0; if (size < 2) goto err_no_more; offset = 0; while (1) { if (data[offset] == MJPEG_MARKER) switch (data[offset + 1]) { case MJPEG_SOI: soi = 1; *data_offset = offset; break; case MJPEG_SOF_0: case MJPEG_SOF_1: if (!soi) { dev_err(delta->dev, "%s wrong sequence, got SOF while SOI not seen\n", pctx->name); return -EINVAL; } ret = delta_mjpeg_read_sof(pctx, &data[offset + 2], size - (offset + 2), header); if (ret) goto err; goto done; default: break; } offset++; if ((offset + 2) >= size) goto err_no_more; } done: dev_dbg(delta->dev, "%s found header @ offset %d:\n%s", pctx->name, *data_offset, header_str(header, str, sizeof(str))); return 0; err_no_more: dev_err(delta->dev, "%s no header found within %d bytes input stream\n", pctx->name, size); return -ENODATA; err: return ret; } |