Rev 2002 | Rev 2015 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2002 | Rev 2005 | ||
---|---|---|---|
Line 37... | Line 37... | ||
37 | * Support for RAM disk images. |
37 | * Support for RAM disk images. |
38 | */ |
38 | */ |
39 | 39 | ||
40 | #include <lib/rd.h> |
40 | #include <lib/rd.h> |
41 | #include <arch/byteorder.h> |
41 | #include <arch/byteorder.h> |
- | 42 | #include <mm/frame.h> |
|
- | 43 | #include <sysinfo/sysinfo.h> |
|
42 | 44 | ||
43 | int init_rd(rd_header * header) |
45 | int init_rd(rd_header * header, size_t size) |
44 | { |
46 | { |
45 | /* Identify RAM disk */ |
47 | /* Identify RAM disk */ |
46 | if ((header->magic[0] != RD_MAG0) || (header->magic[1] != RD_MAG1) || (header->magic[2] != RD_MAG2) || (header->magic[3] != RD_MAG3)) |
48 | if ((header->magic[0] != RD_MAG0) || (header->magic[1] != RD_MAG1) || (header->magic[2] != RD_MAG2) || (header->magic[3] != RD_MAG3)) |
47 | return RE_INVALID; |
49 | return RE_INVALID; |
48 | 50 | ||
49 | /* Identify version */ |
51 | /* Identify version */ |
50 | if (header->version != RD_VERSION) |
52 | if (header->version != RD_VERSION) |
51 | return RE_UNSUPPORTED; |
53 | return RE_UNSUPPORTED; |
52 | 54 | ||
- | 55 | uint32_t hsize; |
|
53 | uint64_t hsize; |
56 | uint64_t dsize; |
54 | switch (header->data_type) { |
57 | switch (header->data_type) { |
55 | case RD_DATA_LSB: |
58 | case RD_DATA_LSB: |
56 | hsize = uint64_t_le2host(header->header_size); |
59 | hsize = uint32_t_le2host(header->header_size); |
- | 60 | dsize = uint64_t_le2host(header->data_size); |
|
- | 61 | break; |
|
- | 62 | case RD_DATA_MSB: |
|
- | 63 | hsize = uint32_t_be2host(header->header_size); |
|
- | 64 | dsize = uint64_t_le2host(header->data_size); |
|
57 | break; |
65 | break; |
58 | // case RD_DATA_MSB: |
- | |
59 | // hsize = uint64_t_be2host(header->header_size); |
- | |
60 | // break; |
- | |
61 | default: |
66 | default: |
62 | return RE_UNSUPPORTED; |
67 | return RE_UNSUPPORTED; |
63 | } |
68 | } |
- | 69 | ||
- | 70 | if ((hsize % FRAME_SIZE) || (dsize % FRAME_SIZE)) |
|
- | 71 | return RE_UNSUPPORTED; |
|
64 | 72 | ||
- | 73 | if (hsize > size) |
|
- | 74 | return RE_INVALID; |
|
- | 75 | ||
- | 76 | if ((uint64_t) hsize + dsize > size) |
|
- | 77 | dsize = size - hsize; |
|
- | 78 | ||
- | 79 | sysinfo_set_item_val("rd", NULL, true); |
|
- | 80 | sysinfo_set_item_val("rd.size", NULL, dsize); |
|
- | 81 | sysinfo_set_item_val("rd.address.physical", NULL, (unative_t) KA2PA((void *) header + hsize)); |
|
65 | 82 | ||
66 | return RE_OK; |
83 | return RE_OK; |
67 | } |
84 | } |
68 | 85 | ||
69 | /** @} |
86 | /** @} |