source: trunk/target/linux/ar71xx/files/drivers/mtd/wrt160nl_part.c @ 17201

Last change on this file since 17201 was 17201, checked in by juhosg, 7 years ago

[ar71xx] WRT160NL: more mtd parser cleanup

  • Property svn:eol-style set to native
File size: 5.0 KB
Line 
1/*
2 * Copyright (C) 2009 Christian Daniel <cd@maintech.de>
3 * Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
18 *
19 * TRX flash partition table.
20 * Based on ar7 map by Felix Fietkau <nbd@openwrt.org>
21 *
22 */
23
24#include <linux/kernel.h>
25#include <linux/slab.h>
26#include <linux/vmalloc.h>
27
28#include <linux/mtd/mtd.h>
29#include <linux/mtd/partitions.h>
30
31struct cybertan_header {
32        char    magic[4];
33        u8      res1[4];
34        char    fw_date[3];
35        char    fw_ver[3];
36        char    id[4];
37        char    hw_ver;
38        char    unused;
39        u8      flags[2];
40        u8      res2[10];
41};
42
43#define TRX_PARTS       6
44#define TRX_MAGIC       0x30524448
45#define TRX_MAX_OFFSET  3
46
47struct trx_header {
48        uint32_t magic;           /* "HDR0" */
49        uint32_t len;             /* Length of file including header */
50        uint32_t crc32;           /* 32-bit CRC from flag_version to end of file */
51        uint32_t flag_version;    /* 0:15 flags, 16:31 version */
52        uint32_t offsets[TRX_MAX_OFFSET]; /* Offsets of partitions from start of header */
53};
54
55#define IH_MAGIC        0x27051956      /* Image Magic Number */
56#define IH_NMLEN        32              /* Image Name Length */
57
58struct uimage_header {
59        uint32_t        ih_magic;       /* Image Header Magic Number */
60        uint32_t        ih_hcrc;        /* Image Header CRC Checksum */
61        uint32_t        ih_time;        /* Image Creation Timestamp */
62        uint32_t        ih_size;        /* Image Data Size */
63        uint32_t        ih_load;        /* Data» Load  Address */
64        uint32_t        ih_ep;          /* Entry Point Address */
65        uint32_t        ih_dcrc;        /* Image Data CRC Checksum */
66        uint8_t         ih_os;          /* Operating System */
67        uint8_t         ih_arch;        /* CPU architecture */
68        uint8_t         ih_type;        /* Image Type */
69        uint8_t         ih_comp;        /* Compression Type */
70        uint8_t         ih_name[IH_NMLEN];      /* Image Name */
71};
72
73struct wrt160nl_header {
74        struct cybertan_header  cybertan;
75        struct trx_header       trx;
76        struct uimage_header    uimage;
77} __attribute__ ((packed));
78
79static struct mtd_partition trx_parts[TRX_PARTS];
80
81static int wrt160nl_parse_partitions(struct mtd_info *master,
82                                     struct mtd_partition **pparts,
83                                     unsigned long origin)
84{
85        struct wrt160nl_header *header;
86        struct trx_header *theader;
87        struct uimage_header *uheader;
88        size_t retlen;
89        unsigned int kernel_len;
90        int ret;
91
92        header = vmalloc(sizeof(*header));
93        if (!header) {
94                return -ENOMEM;
95                goto out;
96        }
97
98        ret = master->read(master, 4 * master->erasesize, sizeof(*header),
99                           &retlen, (void *) header);
100        if (ret)
101                goto free_hdr;
102
103        if (retlen != sizeof(*header)) {
104                ret = -EIO;
105                goto free_hdr;
106        }
107
108        if (strncmp(header->cybertan.magic, "NL16", 4) != 0) {
109                printk(KERN_NOTICE "%s: no WRT160NL signature found\n",
110                        master->name);
111                goto free_hdr;
112        }
113
114        theader = &header->trx;
115        if (le32_to_cpu(theader->magic) != TRX_MAGIC) {
116                printk(KERN_NOTICE "%s: no TRX header found\n", master->name);
117                goto free_hdr;
118        }
119
120        uheader = &header->uimage;
121        if (uheader->ih_magic != IH_MAGIC) {
122                printk(KERN_NOTICE "%s: no uImage found\n", master->name);
123                goto free_hdr;
124        }
125
126        kernel_len = uheader->ih_size / master->erasesize;
127        if (uheader->ih_size % master->erasesize)
128                kernel_len++;
129
130        kernel_len++;
131        kernel_len *= master->erasesize;
132
133        trx_parts[0].name = "u-boot";
134        trx_parts[0].offset = 0;
135        trx_parts[0].size = 4 * master->erasesize;
136        trx_parts[0].mask_flags = MTD_WRITEABLE;
137
138        trx_parts[1].name = "kernel";
139        trx_parts[1].offset = trx_parts[0].offset + trx_parts[0].size;
140        trx_parts[1].size = kernel_len;
141        trx_parts[1].mask_flags = 0;
142
143        trx_parts[2].name = "rootfs";
144        trx_parts[2].offset = trx_parts[1].offset + trx_parts[1].size;
145        trx_parts[2].size = master->size - 6 * master->erasesize - trx_parts[1].size;
146        trx_parts[2].mask_flags = 0;
147
148        trx_parts[3].name = "nvram";
149        trx_parts[3].offset = master->size - 2 * master->erasesize;
150        trx_parts[3].size = master->erasesize;
151        trx_parts[3].mask_flags = MTD_WRITEABLE;
152
153        trx_parts[4].name = "art";
154        trx_parts[4].offset = master->size - master->erasesize;
155        trx_parts[4].size = master->erasesize;
156        trx_parts[4].mask_flags = MTD_WRITEABLE;
157
158        trx_parts[5].name = "firmware";
159        trx_parts[5].offset = 4 * master->erasesize;
160        trx_parts[5].size = master->size - 6 * master->erasesize;
161        trx_parts[5].mask_flags = 0;
162
163        *pparts = trx_parts;
164        ret = TRX_PARTS;
165
166 free_hdr:
167        vfree(header);
168 out:
169        return ret;
170}
171
172static struct mtd_part_parser wrt160nl_parser = {
173        .owner          = THIS_MODULE,
174        .parse_fn       = wrt160nl_parse_partitions,
175        .name           = "wrt160nl",
176};
177
178static int __init wrt160nl_parser_init(void)
179{
180        return register_mtd_parser(&wrt160nl_parser);
181}
182
183module_init(wrt160nl_parser_init);
184
185MODULE_LICENSE("GPL");
186MODULE_AUTHOR("Christian Daniel <cd@maintech.de>");
Note: See TracBrowser for help on using the repository browser.