Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 1 | /* |
| 2 | * libkmod - interface to kernel module operations |
| 3 | * |
Lucas De Marchi | e6b0e49 | 2013-01-16 11:27:21 -0200 | [diff] [blame] | 4 | * Copyright (C) 2011-2013 ProFUSION embedded systems |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 5 | * |
| 6 | * This library is free software; you can redistribute it and/or |
| 7 | * modify it under the terms of the GNU Lesser General Public |
| 8 | * License as published by the Free Software Foundation; either |
| 9 | * version 2.1 of the License, or (at your option) any later version. |
| 10 | * |
| 11 | * This library is distributed in the hope that it will be useful, |
| 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 14 | * Lesser General Public License for more details. |
| 15 | * |
| 16 | * You should have received a copy of the GNU Lesser General Public |
Lucas De Marchi | dea2dfe | 2014-12-25 23:32:03 -0200 | [diff] [blame] | 17 | * License along with this library; if not, see <http://www.gnu.org/licenses/>. |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 18 | */ |
| 19 | |
Lucas De Marchi | c2e4286 | 2014-10-03 01:41:42 -0300 | [diff] [blame] | 20 | #include <errno.h> |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 21 | #include <stdbool.h> |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 22 | #include <stdio.h> |
| 23 | #include <stdlib.h> |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 24 | #include <string.h> |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 25 | #include <sys/mman.h> |
Lucas De Marchi | c2e4286 | 2014-10-03 01:41:42 -0300 | [diff] [blame] | 26 | #include <sys/stat.h> |
| 27 | #include <sys/types.h> |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 28 | #include <unistd.h> |
Torge Matthies | 3821e19 | 2020-09-08 21:59:20 +0200 | [diff] [blame] | 29 | #ifdef ENABLE_ZSTD |
| 30 | #include <zstd.h> |
| 31 | #endif |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 32 | #ifdef ENABLE_XZ |
| 33 | #include <lzma.h> |
| 34 | #endif |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 35 | #ifdef ENABLE_ZLIB |
| 36 | #include <zlib.h> |
| 37 | #endif |
| 38 | |
Lucas De Marchi | c2e4286 | 2014-10-03 01:41:42 -0300 | [diff] [blame] | 39 | #include <shared/util.h> |
| 40 | |
| 41 | #include "libkmod.h" |
| 42 | #include "libkmod-internal.h" |
| 43 | |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 44 | struct kmod_file; |
| 45 | struct file_ops { |
| 46 | int (*load)(struct kmod_file *file); |
| 47 | void (*unload)(struct kmod_file *file); |
| 48 | }; |
| 49 | |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 50 | struct kmod_file { |
Torge Matthies | 3821e19 | 2020-09-08 21:59:20 +0200 | [diff] [blame] | 51 | #ifdef ENABLE_ZSTD |
| 52 | bool zstd_used; |
| 53 | #endif |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 54 | #ifdef ENABLE_XZ |
| 55 | bool xz_used; |
| 56 | #endif |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 57 | #ifdef ENABLE_ZLIB |
| 58 | gzFile gzf; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 59 | #endif |
Gustavo Sverzut Barbieri | bb41709 | 2011-12-24 00:09:31 -0200 | [diff] [blame] | 60 | int fd; |
Kees Cook | 144d182 | 2013-02-18 12:02:32 -0800 | [diff] [blame] | 61 | bool direct; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 62 | off_t size; |
| 63 | void *memory; |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 64 | const struct file_ops *ops; |
Lucas De Marchi | c68e92f | 2012-01-04 08:19:34 -0200 | [diff] [blame] | 65 | const struct kmod_ctx *ctx; |
Lucas De Marchi | 1eff942 | 2012-10-18 01:36:33 -0300 | [diff] [blame] | 66 | struct kmod_elf *elf; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 67 | }; |
| 68 | |
Torge Matthies | 3821e19 | 2020-09-08 21:59:20 +0200 | [diff] [blame] | 69 | #ifdef ENABLE_ZSTD |
| 70 | static int zstd_read_block(struct kmod_file *file, size_t block_size, |
| 71 | ZSTD_inBuffer *input, size_t *input_capacity) |
| 72 | { |
| 73 | ssize_t rdret; |
| 74 | int ret; |
| 75 | |
| 76 | if (*input_capacity < block_size) { |
| 77 | free((void *)input->src); |
| 78 | input->src = malloc(block_size); |
| 79 | if (input->src == NULL) { |
| 80 | ret = -errno; |
| 81 | ERR(file->ctx, "zstd: %m\n"); |
| 82 | return ret; |
| 83 | } |
| 84 | *input_capacity = block_size; |
| 85 | } |
| 86 | |
| 87 | rdret = read(file->fd, (void *)input->src, block_size); |
| 88 | if (rdret < 0) { |
| 89 | ret = -errno; |
| 90 | ERR(file->ctx, "zstd: %m\n"); |
| 91 | return ret; |
| 92 | } |
| 93 | |
| 94 | input->pos = 0; |
| 95 | input->size = rdret; |
| 96 | return 0; |
| 97 | } |
| 98 | |
| 99 | static int zstd_ensure_outbuffer_space(ZSTD_outBuffer *buffer, size_t min_free) |
| 100 | { |
| 101 | uint8_t *old_buffer = buffer->dst; |
| 102 | int ret = 0; |
| 103 | |
| 104 | if (buffer->size - buffer->pos >= min_free) |
| 105 | return 0; |
| 106 | |
| 107 | buffer->size += min_free; |
| 108 | buffer->dst = realloc(buffer->dst, buffer->size); |
| 109 | if (buffer->dst == NULL) { |
| 110 | ret = -errno; |
| 111 | free(old_buffer); |
| 112 | } |
| 113 | |
| 114 | return ret; |
| 115 | } |
| 116 | |
| 117 | static int zstd_decompress_block(struct kmod_file *file, ZSTD_DStream *dstr, |
| 118 | ZSTD_inBuffer *input, ZSTD_outBuffer *output, |
| 119 | size_t *next_block_size) |
| 120 | { |
| 121 | size_t out_buf_min_size = ZSTD_DStreamOutSize(); |
| 122 | int ret = 0; |
| 123 | |
| 124 | do { |
| 125 | ssize_t dsret; |
| 126 | |
| 127 | ret = zstd_ensure_outbuffer_space(output, out_buf_min_size); |
| 128 | if (ret) { |
| 129 | ERR(file->ctx, "zstd: %s\n", strerror(-ret)); |
| 130 | break; |
| 131 | } |
| 132 | |
| 133 | dsret = ZSTD_decompressStream(dstr, output, input); |
| 134 | if (ZSTD_isError(dsret)) { |
| 135 | ret = -EINVAL; |
| 136 | ERR(file->ctx, "zstd: %s\n", ZSTD_getErrorName(dsret)); |
| 137 | break; |
| 138 | } |
| 139 | if (dsret > 0) |
| 140 | *next_block_size = (size_t)dsret; |
| 141 | } while (input->pos < input->size |
| 142 | || output->pos > output->size |
| 143 | || output->size - output->pos < out_buf_min_size); |
| 144 | |
| 145 | return ret; |
| 146 | } |
| 147 | |
| 148 | static int load_zstd(struct kmod_file *file) |
| 149 | { |
| 150 | ZSTD_DStream *dstr; |
| 151 | size_t next_block_size; |
| 152 | size_t zst_inb_capacity = 0; |
| 153 | ZSTD_inBuffer zst_inb = { 0 }; |
| 154 | ZSTD_outBuffer zst_outb = { 0 }; |
| 155 | int ret; |
| 156 | |
| 157 | dstr = ZSTD_createDStream(); |
| 158 | if (dstr == NULL) { |
| 159 | ret = -EINVAL; |
| 160 | ERR(file->ctx, "zstd: Failed to create decompression stream\n"); |
| 161 | goto out; |
| 162 | } |
| 163 | |
| 164 | next_block_size = ZSTD_initDStream(dstr); |
| 165 | |
| 166 | while (true) { |
| 167 | ret = zstd_read_block(file, next_block_size, &zst_inb, |
| 168 | &zst_inb_capacity); |
| 169 | if (ret != 0) |
| 170 | goto out; |
| 171 | if (zst_inb.size == 0) /* EOF */ |
| 172 | break; |
| 173 | |
| 174 | ret = zstd_decompress_block(file, dstr, &zst_inb, &zst_outb, |
| 175 | &next_block_size); |
| 176 | if (ret != 0) |
| 177 | goto out; |
| 178 | } |
| 179 | |
| 180 | ZSTD_freeDStream(dstr); |
| 181 | free((void *)zst_inb.src); |
| 182 | file->zstd_used = true; |
| 183 | file->memory = zst_outb.dst; |
| 184 | file->size = zst_outb.pos; |
| 185 | return 0; |
| 186 | out: |
| 187 | if (dstr != NULL) |
| 188 | ZSTD_freeDStream(dstr); |
| 189 | free((void *)zst_inb.src); |
| 190 | free((void *)zst_outb.dst); |
| 191 | return ret; |
| 192 | } |
| 193 | |
| 194 | static void unload_zstd(struct kmod_file *file) |
| 195 | { |
| 196 | if (!file->zstd_used) |
| 197 | return; |
| 198 | free(file->memory); |
| 199 | } |
| 200 | |
| 201 | static const char magic_zstd[] = {0x28, 0xB5, 0x2F, 0xFD}; |
| 202 | #endif |
| 203 | |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 204 | #ifdef ENABLE_XZ |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 205 | static void xz_uncompress_belch(struct kmod_file *file, lzma_ret ret) |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 206 | { |
| 207 | switch (ret) { |
| 208 | case LZMA_MEM_ERROR: |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 209 | ERR(file->ctx, "xz: %s\n", strerror(ENOMEM)); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 210 | break; |
| 211 | case LZMA_FORMAT_ERROR: |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 212 | ERR(file->ctx, "xz: File format not recognized\n"); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 213 | break; |
| 214 | case LZMA_OPTIONS_ERROR: |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 215 | ERR(file->ctx, "xz: Unsupported compression options\n"); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 216 | break; |
| 217 | case LZMA_DATA_ERROR: |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 218 | ERR(file->ctx, "xz: File is corrupt\n"); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 219 | break; |
| 220 | case LZMA_BUF_ERROR: |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 221 | ERR(file->ctx, "xz: Unexpected end of input\n"); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 222 | break; |
| 223 | default: |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 224 | ERR(file->ctx, "xz: Internal error (bug)\n"); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 225 | break; |
| 226 | } |
| 227 | } |
| 228 | |
| 229 | static int xz_uncompress(lzma_stream *strm, struct kmod_file *file) |
| 230 | { |
| 231 | uint8_t in_buf[BUFSIZ], out_buf[BUFSIZ]; |
| 232 | lzma_action action = LZMA_RUN; |
| 233 | lzma_ret ret; |
| 234 | void *p = NULL; |
| 235 | size_t total = 0; |
| 236 | |
| 237 | strm->avail_in = 0; |
| 238 | strm->next_out = out_buf; |
| 239 | strm->avail_out = sizeof(out_buf); |
| 240 | |
| 241 | while (true) { |
| 242 | if (strm->avail_in == 0) { |
| 243 | ssize_t rdret = read(file->fd, in_buf, sizeof(in_buf)); |
| 244 | if (rdret < 0) { |
| 245 | ret = -errno; |
| 246 | goto out; |
| 247 | } |
| 248 | strm->next_in = in_buf; |
| 249 | strm->avail_in = rdret; |
| 250 | if (rdret == 0) |
| 251 | action = LZMA_FINISH; |
| 252 | } |
| 253 | ret = lzma_code(strm, action); |
| 254 | if (strm->avail_out == 0 || ret != LZMA_OK) { |
| 255 | size_t write_size = BUFSIZ - strm->avail_out; |
| 256 | char *tmp = realloc(p, total + write_size); |
| 257 | if (tmp == NULL) { |
| 258 | ret = -errno; |
| 259 | goto out; |
| 260 | } |
| 261 | memcpy(tmp + total, out_buf, write_size); |
| 262 | total += write_size; |
| 263 | p = tmp; |
| 264 | strm->next_out = out_buf; |
| 265 | strm->avail_out = BUFSIZ; |
| 266 | } |
| 267 | if (ret == LZMA_STREAM_END) |
| 268 | break; |
| 269 | if (ret != LZMA_OK) { |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 270 | xz_uncompress_belch(file, ret); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 271 | ret = -EINVAL; |
| 272 | goto out; |
| 273 | } |
| 274 | } |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 275 | file->xz_used = true; |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 276 | file->memory = p; |
| 277 | file->size = total; |
| 278 | return 0; |
| 279 | out: |
| 280 | free(p); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 281 | return ret; |
| 282 | } |
| 283 | |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 284 | static int load_xz(struct kmod_file *file) |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 285 | { |
| 286 | lzma_stream strm = LZMA_STREAM_INIT; |
| 287 | lzma_ret lzret; |
| 288 | int ret; |
| 289 | |
| 290 | lzret = lzma_stream_decoder(&strm, UINT64_MAX, LZMA_CONCATENATED); |
| 291 | if (lzret == LZMA_MEM_ERROR) { |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 292 | ERR(file->ctx, "xz: %s\n", strerror(ENOMEM)); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 293 | return -ENOMEM; |
| 294 | } else if (lzret != LZMA_OK) { |
Lucas De Marchi | 3f63505 | 2012-01-04 08:23:15 -0200 | [diff] [blame] | 295 | ERR(file->ctx, "xz: Internal error (bug)\n"); |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 296 | return -EINVAL; |
| 297 | } |
| 298 | ret = xz_uncompress(&strm, file); |
| 299 | lzma_end(&strm); |
| 300 | return ret; |
| 301 | } |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 302 | |
| 303 | static void unload_xz(struct kmod_file *file) |
| 304 | { |
| 305 | if (!file->xz_used) |
| 306 | return; |
| 307 | free(file->memory); |
| 308 | } |
| 309 | |
| 310 | static const char magic_xz[] = {0xfd, '7', 'z', 'X', 'Z', 0}; |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 311 | #endif |
| 312 | |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 313 | #ifdef ENABLE_ZLIB |
| 314 | #define READ_STEP (4 * 1024 * 1024) |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 315 | static int load_zlib(struct kmod_file *file) |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 316 | { |
| 317 | int err = 0; |
| 318 | off_t did = 0, total = 0; |
Lucas De Marchi | d3c16c7 | 2013-11-18 11:43:10 -0200 | [diff] [blame] | 319 | _cleanup_free_ unsigned char *p = NULL; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 320 | |
| 321 | errno = 0; |
Gustavo Sverzut Barbieri | bb41709 | 2011-12-24 00:09:31 -0200 | [diff] [blame] | 322 | file->gzf = gzdopen(file->fd, "rb"); |
Lucas De Marchi | d3c16c7 | 2013-11-18 11:43:10 -0200 | [diff] [blame] | 323 | if (file->gzf == NULL) |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 324 | return -errno; |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 325 | file->fd = -1; /* now owned by gzf due gzdopen() */ |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 326 | |
| 327 | for (;;) { |
| 328 | int r; |
| 329 | |
| 330 | if (did == total) { |
| 331 | void *tmp = realloc(p, total + READ_STEP); |
| 332 | if (tmp == NULL) { |
| 333 | err = -errno; |
| 334 | goto error; |
| 335 | } |
| 336 | total += READ_STEP; |
| 337 | p = tmp; |
| 338 | } |
| 339 | |
| 340 | r = gzread(file->gzf, p + did, total - did); |
| 341 | if (r == 0) |
| 342 | break; |
| 343 | else if (r < 0) { |
Dave Reisner | c7d5a60 | 2012-05-07 19:41:41 -0400 | [diff] [blame] | 344 | int gzerr; |
| 345 | const char *gz_errmsg = gzerror(file->gzf, &gzerr); |
| 346 | |
| 347 | ERR(file->ctx, "gzip: %s\n", gz_errmsg); |
| 348 | |
| 349 | /* gzip might not set errno here */ |
| 350 | err = gzerr == Z_ERRNO ? -errno : -EINVAL; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 351 | goto error; |
| 352 | } |
| 353 | did += r; |
| 354 | } |
| 355 | |
| 356 | file->memory = p; |
| 357 | file->size = did; |
Lucas De Marchi | d3c16c7 | 2013-11-18 11:43:10 -0200 | [diff] [blame] | 358 | p = NULL; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 359 | return 0; |
Lucas De Marchi | d3c16c7 | 2013-11-18 11:43:10 -0200 | [diff] [blame] | 360 | |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 361 | error: |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 362 | gzclose(file->gzf); |
| 363 | return err; |
| 364 | } |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 365 | |
| 366 | static void unload_zlib(struct kmod_file *file) |
| 367 | { |
| 368 | if (file->gzf == NULL) |
| 369 | return; |
| 370 | free(file->memory); |
| 371 | gzclose(file->gzf); /* closes file->fd */ |
| 372 | } |
| 373 | |
| 374 | static const char magic_zlib[] = {0x1f, 0x8b}; |
Gustavo Sverzut Barbieri | bb41709 | 2011-12-24 00:09:31 -0200 | [diff] [blame] | 375 | #endif |
| 376 | |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 377 | static const struct comp_type { |
| 378 | size_t magic_size; |
| 379 | const char *magic_bytes; |
| 380 | const struct file_ops ops; |
| 381 | } comp_types[] = { |
Torge Matthies | 3821e19 | 2020-09-08 21:59:20 +0200 | [diff] [blame] | 382 | #ifdef ENABLE_ZSTD |
| 383 | {sizeof(magic_zstd), magic_zstd, {load_zstd, unload_zstd}}, |
| 384 | #endif |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 385 | #ifdef ENABLE_XZ |
| 386 | {sizeof(magic_xz), magic_xz, {load_xz, unload_xz}}, |
| 387 | #endif |
| 388 | #ifdef ENABLE_ZLIB |
| 389 | {sizeof(magic_zlib), magic_zlib, {load_zlib, unload_zlib}}, |
| 390 | #endif |
| 391 | {0, NULL, {NULL, NULL}} |
| 392 | }; |
| 393 | |
| 394 | static int load_reg(struct kmod_file *file) |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 395 | { |
| 396 | struct stat st; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 397 | |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 398 | if (fstat(file->fd, &st) < 0) |
| 399 | return -errno; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 400 | |
| 401 | file->size = st.st_size; |
Kees Cook | c3e8d26 | 2013-02-18 12:02:34 -0800 | [diff] [blame] | 402 | file->memory = mmap(NULL, file->size, PROT_READ, MAP_PRIVATE, |
| 403 | file->fd, 0); |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 404 | if (file->memory == MAP_FAILED) |
| 405 | return -errno; |
Kees Cook | 144d182 | 2013-02-18 12:02:32 -0800 | [diff] [blame] | 406 | file->direct = true; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 407 | return 0; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 408 | } |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 409 | |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 410 | static void unload_reg(struct kmod_file *file) |
| 411 | { |
| 412 | munmap(file->memory, file->size); |
| 413 | } |
| 414 | |
Lucas De Marchi | 7749bed | 2012-01-04 08:00:45 -0200 | [diff] [blame] | 415 | static const struct file_ops reg_ops = { |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 416 | load_reg, unload_reg |
| 417 | }; |
| 418 | |
Lucas De Marchi | 1eff942 | 2012-10-18 01:36:33 -0300 | [diff] [blame] | 419 | struct kmod_elf *kmod_file_get_elf(struct kmod_file *file) |
| 420 | { |
| 421 | if (file->elf) |
| 422 | return file->elf; |
| 423 | |
| 424 | file->elf = kmod_elf_new(file->memory, file->size); |
| 425 | return file->elf; |
| 426 | } |
| 427 | |
Lucas De Marchi | c68e92f | 2012-01-04 08:19:34 -0200 | [diff] [blame] | 428 | struct kmod_file *kmod_file_open(const struct kmod_ctx *ctx, |
| 429 | const char *filename) |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 430 | { |
| 431 | struct kmod_file *file = calloc(1, sizeof(struct kmod_file)); |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 432 | const struct comp_type *itr; |
| 433 | size_t magic_size_max = 0; |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 434 | int err; |
| 435 | |
| 436 | if (file == NULL) |
| 437 | return NULL; |
| 438 | |
Gustavo Sverzut Barbieri | bb41709 | 2011-12-24 00:09:31 -0200 | [diff] [blame] | 439 | file->fd = open(filename, O_RDONLY|O_CLOEXEC); |
| 440 | if (file->fd < 0) { |
| 441 | err = -errno; |
| 442 | goto error; |
| 443 | } |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 444 | |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 445 | for (itr = comp_types; itr->ops.load != NULL; itr++) { |
| 446 | if (magic_size_max < itr->magic_size) |
| 447 | magic_size_max = itr->magic_size; |
| 448 | } |
Gustavo Sverzut Barbieri | bb41709 | 2011-12-24 00:09:31 -0200 | [diff] [blame] | 449 | |
Kees Cook | 144d182 | 2013-02-18 12:02:32 -0800 | [diff] [blame] | 450 | file->direct = false; |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 451 | if (magic_size_max > 0) { |
| 452 | char *buf = alloca(magic_size_max + 1); |
| 453 | ssize_t sz; |
| 454 | |
| 455 | if (buf == NULL) { |
| 456 | err = -errno; |
| 457 | goto error; |
| 458 | } |
| 459 | sz = read_str_safe(file->fd, buf, magic_size_max + 1); |
| 460 | lseek(file->fd, 0, SEEK_SET); |
| 461 | if (sz != (ssize_t)magic_size_max) { |
| 462 | if (sz < 0) |
| 463 | err = sz; |
| 464 | else |
| 465 | err = -EINVAL; |
| 466 | goto error; |
| 467 | } |
| 468 | |
| 469 | for (itr = comp_types; itr->ops.load != NULL; itr++) { |
| 470 | if (memcmp(buf, itr->magic_bytes, itr->magic_size) == 0) |
| 471 | break; |
| 472 | } |
| 473 | if (itr->ops.load != NULL) |
| 474 | file->ops = &itr->ops; |
| 475 | } |
| 476 | |
| 477 | if (file->ops == NULL) |
| 478 | file->ops = ®_ops; |
| 479 | |
| 480 | err = file->ops->load(file); |
Lucas De Marchi | c68e92f | 2012-01-04 08:19:34 -0200 | [diff] [blame] | 481 | file->ctx = ctx; |
Gustavo Sverzut Barbieri | bb41709 | 2011-12-24 00:09:31 -0200 | [diff] [blame] | 482 | error: |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 483 | if (err < 0) { |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 484 | if (file->fd >= 0) |
| 485 | close(file->fd); |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 486 | free(file); |
| 487 | errno = -err; |
| 488 | return NULL; |
| 489 | } |
| 490 | |
| 491 | return file; |
| 492 | } |
| 493 | |
| 494 | void *kmod_file_get_contents(const struct kmod_file *file) |
| 495 | { |
| 496 | return file->memory; |
| 497 | } |
| 498 | |
| 499 | off_t kmod_file_get_size(const struct kmod_file *file) |
| 500 | { |
| 501 | return file->size; |
| 502 | } |
| 503 | |
Kees Cook | 144d182 | 2013-02-18 12:02:32 -0800 | [diff] [blame] | 504 | bool kmod_file_get_direct(const struct kmod_file *file) |
| 505 | { |
| 506 | return file->direct; |
| 507 | } |
| 508 | |
| 509 | int kmod_file_get_fd(const struct kmod_file *file) |
| 510 | { |
| 511 | return file->fd; |
| 512 | } |
| 513 | |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 514 | void kmod_file_unref(struct kmod_file *file) |
| 515 | { |
Lucas De Marchi | 1eff942 | 2012-10-18 01:36:33 -0300 | [diff] [blame] | 516 | if (file->elf) |
| 517 | kmod_elf_unref(file->elf); |
| 518 | |
Gustavo Sverzut Barbieri | db5d14c | 2012-01-03 14:25:49 -0200 | [diff] [blame] | 519 | file->ops->unload(file); |
| 520 | if (file->fd >= 0) |
Jan Engelhardt | b182f8f | 2011-12-24 14:58:30 +0100 | [diff] [blame] | 521 | close(file->fd); |
Gustavo Sverzut Barbieri | 3d8226e | 2011-12-16 16:08:53 -0200 | [diff] [blame] | 522 | free(file); |
| 523 | } |