hc
2024-08-12 233ab1bd4c5697f5cdec94e60206e8c6ac609b4c
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
/*
 * (C) Copyright 2015
 * Lukasz Majewski <l.majewski@majess.pl>
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <common.h>
#include <malloc.h>
#include <errno.h>
#include <dfu.h>
 
int dfu_tftp_write(char *dfu_entity_name, unsigned int addr, unsigned int len,
          char *interface, char *devstring)
{
   char *s, *sb;
   int alt_setting_num, ret;
   struct dfu_entity *dfu;
 
   debug("%s: name: %s addr: 0x%x len: %d device: %s:%s\n", __func__,
         dfu_entity_name, addr, len, interface, devstring);
 
   ret = dfu_init_env_entities(interface, devstring);
   if (ret)
       goto done;
 
   /*
    * We need to copy name pointed by *dfu_entity_name since this text
    * is the integral part of the FDT image.
    * Any implicit modification (i.e. done by strsep()) will corrupt
    * the FDT image and prevent other images to be stored.
    */
   s = strdup(dfu_entity_name);
   sb = s;
   if (!s) {
       ret = -ENOMEM;
       goto done;
   }
 
   strsep(&s, "@");
   debug("%s: image name: %s strlen: %d\n", __func__, sb, strlen(sb));
 
   alt_setting_num = dfu_get_alt(sb);
   free(sb);
   if (alt_setting_num < 0) {
       pr_err("Alt setting [%d] to write not found!",
             alt_setting_num);
       ret = -ENODEV;
       goto done;
   }
 
   dfu = dfu_get_entity(alt_setting_num);
   if (!dfu) {
       pr_err("DFU entity for alt: %d not found!", alt_setting_num);
       ret = -ENODEV;
       goto done;
   }
 
   ret = dfu_write_from_mem_addr(dfu, (void *)addr, len);
 
done:
   dfu_free_entities();
 
   return ret;
}