2 * dfu.c -- DFU back-end routines
4 * Copyright (C) 2012 Samsung Electronics
5 * author: Lukasz Majewski <l.majewski@samsung.com>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
33 static unsigned char __aligned(CONFIG_SYS_CACHELINE_SIZE
)
34 dfu_file_buf
[CONFIG_SYS_DFU_MAX_FILE_SIZE
];
35 static long dfu_file_buf_len
;
37 static int mmc_block_op(enum dfu_mmc_op op
, struct dfu_entity
*dfu
,
38 u64 offset
, void *buf
, long *len
)
40 char cmd_buf
[DFU_CMD_BUF_SIZE
];
41 u32 blk_start
, blk_count
;
44 * We must ensure that we work in lba_blk_size chunks, so ALIGN
47 *len
= ALIGN(*len
, dfu
->data
.mmc
.lba_blk_size
);
49 blk_start
= dfu
->data
.mmc
.lba_start
+
50 (u32
)lldiv(offset
, dfu
->data
.mmc
.lba_blk_size
);
51 blk_count
= *len
/ dfu
->data
.mmc
.lba_blk_size
;
52 if (blk_start
+ blk_count
>
53 dfu
->data
.mmc
.lba_start
+ dfu
->data
.mmc
.lba_size
) {
54 puts("Request would exceed designated area!\n");
58 sprintf(cmd_buf
, "mmc %s %p %x %x",
59 op
== DFU_OP_READ
? "read" : "write",
60 buf
, blk_start
, blk_count
);
62 debug("%s: %s 0x%p\n", __func__
, cmd_buf
, cmd_buf
);
63 return run_command(cmd_buf
, 0);
66 static int mmc_file_buffer(struct dfu_entity
*dfu
, void *buf
, long *len
)
68 if (dfu_file_buf_len
+ *len
> CONFIG_SYS_DFU_MAX_FILE_SIZE
) {
73 /* Add to the current buffer. */
74 memcpy(dfu_file_buf
+ dfu_file_buf_len
, buf
, *len
);
75 dfu_file_buf_len
+= *len
;
80 static int mmc_file_op(enum dfu_mmc_op op
, struct dfu_entity
*dfu
,
83 char cmd_buf
[DFU_CMD_BUF_SIZE
];
87 switch (dfu
->layout
) {
89 sprintf(cmd_buf
, "fat%s mmc %d:%d 0x%x %s",
90 op
== DFU_OP_READ
? "load" : "write",
91 dfu
->data
.mmc
.dev
, dfu
->data
.mmc
.part
,
92 (unsigned int) buf
, dfu
->name
);
93 if (op
== DFU_OP_WRITE
)
94 sprintf(cmd_buf
+ strlen(cmd_buf
), " %lx", *len
);
97 sprintf(cmd_buf
, "ext4%s mmc %d:%d 0x%x /%s",
98 op
== DFU_OP_READ
? "load" : "write",
99 dfu
->data
.mmc
.dev
, dfu
->data
.mmc
.part
,
100 (unsigned int) buf
, dfu
->name
);
103 printf("%s: Layout (%s) not (yet) supported!\n", __func__
,
104 dfu_get_layout(dfu
->layout
));
108 debug("%s: %s 0x%p\n", __func__
, cmd_buf
, cmd_buf
);
110 ret
= run_command(cmd_buf
, 0);
112 puts("dfu: Read error!\n");
116 if (dfu
->layout
!= DFU_RAW_ADDR
&& op
== DFU_OP_READ
) {
117 str_env
= getenv("filesize");
118 if (str_env
== NULL
) {
119 puts("dfu: Wrong file size!\n");
122 *len
= simple_strtoul(str_env
, NULL
, 16);
128 int dfu_write_medium_mmc(struct dfu_entity
*dfu
,
129 u64 offset
, void *buf
, long *len
)
133 switch (dfu
->layout
) {
135 ret
= mmc_block_op(DFU_OP_WRITE
, dfu
, offset
, buf
, len
);
139 ret
= mmc_file_buffer(dfu
, buf
, len
);
142 printf("%s: Layout (%s) not (yet) supported!\n", __func__
,
143 dfu_get_layout(dfu
->layout
));
149 int dfu_flush_medium_mmc(struct dfu_entity
*dfu
)
153 if (dfu
->layout
!= DFU_RAW_ADDR
) {
155 ret
= mmc_file_op(DFU_OP_WRITE
, dfu
, &dfu_file_buf
,
158 /* Now that we're done */
159 dfu_file_buf_len
= 0;
165 int dfu_read_medium_mmc(struct dfu_entity
*dfu
, u64 offset
, void *buf
,
170 switch (dfu
->layout
) {
172 ret
= mmc_block_op(DFU_OP_READ
, dfu
, offset
, buf
, len
);
176 ret
= mmc_file_op(DFU_OP_READ
, dfu
, buf
, len
);
179 printf("%s: Layout (%s) not (yet) supported!\n", __func__
,
180 dfu_get_layout(dfu
->layout
));
186 int dfu_fill_entity_mmc(struct dfu_entity
*dfu
, char *s
)
190 block_dev_desc_t
*blk_dev
;
191 disk_partition_t partinfo
;
194 dfu
->dev_type
= DFU_DEV_MMC
;
195 st
= strsep(&s
, " ");
196 if (!strcmp(st
, "mmc")) {
197 dfu
->layout
= DFU_RAW_ADDR
;
198 dfu
->data
.mmc
.lba_start
= simple_strtoul(s
, &s
, 16);
199 dfu
->data
.mmc
.lba_size
= simple_strtoul(++s
, &s
, 16);
200 dfu
->data
.mmc
.lba_blk_size
= get_mmc_blk_size(dfu
->dev_num
);
201 } else if (!strcmp(st
, "fat")) {
202 dfu
->layout
= DFU_FS_FAT
;
203 } else if (!strcmp(st
, "ext4")) {
204 dfu
->layout
= DFU_FS_EXT4
;
205 } else if (!strcmp(st
, "part")) {
207 dfu
->layout
= DFU_RAW_ADDR
;
209 dev
= simple_strtoul(s
, &s
, 10);
211 part
= simple_strtoul(s
, &s
, 10);
213 mmc
= find_mmc_device(dev
);
214 if (mmc
== NULL
|| mmc_init(mmc
)) {
215 printf("%s: could not find mmc device #%d!\n",
220 blk_dev
= &mmc
->block_dev
;
221 if (get_partition_info(blk_dev
, part
, &partinfo
) != 0) {
222 printf("%s: could not find partition #%d on mmc device #%d!\n",
223 __func__
, part
, dev
);
227 dfu
->data
.mmc
.lba_start
= partinfo
.start
;
228 dfu
->data
.mmc
.lba_size
= partinfo
.size
;
229 dfu
->data
.mmc
.lba_blk_size
= partinfo
.blksz
;
232 printf("%s: Memory layout (%s) not supported!\n", __func__
, st
);
236 if (dfu
->layout
== DFU_FS_EXT4
|| dfu
->layout
== DFU_FS_FAT
) {
237 dfu
->data
.mmc
.dev
= simple_strtoul(s
, &s
, 10);
238 dfu
->data
.mmc
.part
= simple_strtoul(++s
, &s
, 10);
241 dfu
->read_medium
= dfu_read_medium_mmc
;
242 dfu
->write_medium
= dfu_write_medium_mmc
;
243 dfu
->flush_medium
= dfu_flush_medium_mmc
;