xref: /rk3399_rockchip-uboot/lib/avb/libavb/avb_property_descriptor.c (revision ab608f806ee1d7fa63a18cc035e8ea62b67634e5)
1*37a7bc39SJason Zhu /*
2*37a7bc39SJason Zhu  * Copyright (C) 2016 The Android Open Source Project
3*37a7bc39SJason Zhu  *
4*37a7bc39SJason Zhu  * Permission is hereby granted, free of charge, to any person
5*37a7bc39SJason Zhu  * obtaining a copy of this software and associated documentation
6*37a7bc39SJason Zhu  * files (the "Software"), to deal in the Software without
7*37a7bc39SJason Zhu  * restriction, including without limitation the rights to use, copy,
8*37a7bc39SJason Zhu  * modify, merge, publish, distribute, sublicense, and/or sell copies
9*37a7bc39SJason Zhu  * of the Software, and to permit persons to whom the Software is
10*37a7bc39SJason Zhu  * furnished to do so, subject to the following conditions:
11*37a7bc39SJason Zhu  *
12*37a7bc39SJason Zhu  * The above copyright notice and this permission notice shall be
13*37a7bc39SJason Zhu  * included in all copies or substantial portions of the Software.
14*37a7bc39SJason Zhu  *
15*37a7bc39SJason Zhu  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
16*37a7bc39SJason Zhu  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
17*37a7bc39SJason Zhu  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
18*37a7bc39SJason Zhu  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
19*37a7bc39SJason Zhu  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
20*37a7bc39SJason Zhu  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
21*37a7bc39SJason Zhu  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
22*37a7bc39SJason Zhu  * SOFTWARE.
23*37a7bc39SJason Zhu  */
24*37a7bc39SJason Zhu 
25*37a7bc39SJason Zhu #include <android_avb/avb_property_descriptor.h>
26*37a7bc39SJason Zhu #include <android_avb/avb_util.h>
27*37a7bc39SJason Zhu 
avb_property_descriptor_validate_and_byteswap(const AvbPropertyDescriptor * src,AvbPropertyDescriptor * dest)28*37a7bc39SJason Zhu bool avb_property_descriptor_validate_and_byteswap(
29*37a7bc39SJason Zhu     const AvbPropertyDescriptor* src, AvbPropertyDescriptor* dest) {
30*37a7bc39SJason Zhu   uint64_t expected_size;
31*37a7bc39SJason Zhu 
32*37a7bc39SJason Zhu   avb_memcpy(dest, src, sizeof(AvbPropertyDescriptor));
33*37a7bc39SJason Zhu 
34*37a7bc39SJason Zhu   if (!avb_descriptor_validate_and_byteswap((const AvbDescriptor*)src,
35*37a7bc39SJason Zhu                                             (AvbDescriptor*)dest))
36*37a7bc39SJason Zhu     return false;
37*37a7bc39SJason Zhu 
38*37a7bc39SJason Zhu   if (dest->parent_descriptor.tag != AVB_DESCRIPTOR_TAG_PROPERTY) {
39*37a7bc39SJason Zhu     avb_error("Invalid tag for property descriptor.\n");
40*37a7bc39SJason Zhu     return false;
41*37a7bc39SJason Zhu   }
42*37a7bc39SJason Zhu 
43*37a7bc39SJason Zhu   dest->key_num_bytes = avb_be64toh(dest->key_num_bytes);
44*37a7bc39SJason Zhu   dest->value_num_bytes = avb_be64toh(dest->value_num_bytes);
45*37a7bc39SJason Zhu 
46*37a7bc39SJason Zhu   /* Check that key and value are fully contained. */
47*37a7bc39SJason Zhu   expected_size = sizeof(AvbPropertyDescriptor) - sizeof(AvbDescriptor) + 2;
48*37a7bc39SJason Zhu   if (!avb_safe_add_to(&expected_size, dest->key_num_bytes) ||
49*37a7bc39SJason Zhu       !avb_safe_add_to(&expected_size, dest->value_num_bytes)) {
50*37a7bc39SJason Zhu     avb_error("Overflow while adding up sizes.\n");
51*37a7bc39SJason Zhu     return false;
52*37a7bc39SJason Zhu   }
53*37a7bc39SJason Zhu   if (expected_size > dest->parent_descriptor.num_bytes_following) {
54*37a7bc39SJason Zhu     avb_error("Descriptor payload size overflow.\n");
55*37a7bc39SJason Zhu     return false;
56*37a7bc39SJason Zhu   }
57*37a7bc39SJason Zhu 
58*37a7bc39SJason Zhu   return true;
59*37a7bc39SJason Zhu }
60*37a7bc39SJason Zhu 
61*37a7bc39SJason Zhu typedef struct {
62*37a7bc39SJason Zhu   const char* key;
63*37a7bc39SJason Zhu   size_t key_size;
64*37a7bc39SJason Zhu   const char* ret_value;
65*37a7bc39SJason Zhu   size_t ret_value_size;
66*37a7bc39SJason Zhu } PropertyIteratorData;
67*37a7bc39SJason Zhu 
property_lookup_desc_foreach(const AvbDescriptor * header,void * user_data)68*37a7bc39SJason Zhu static bool property_lookup_desc_foreach(const AvbDescriptor* header,
69*37a7bc39SJason Zhu                                          void* user_data) {
70*37a7bc39SJason Zhu   PropertyIteratorData* data = (PropertyIteratorData*)user_data;
71*37a7bc39SJason Zhu   AvbPropertyDescriptor prop_desc;
72*37a7bc39SJason Zhu   const uint8_t* p;
73*37a7bc39SJason Zhu   bool ret = true;
74*37a7bc39SJason Zhu 
75*37a7bc39SJason Zhu   if (header->tag != AVB_DESCRIPTOR_TAG_PROPERTY) {
76*37a7bc39SJason Zhu     goto out;
77*37a7bc39SJason Zhu   }
78*37a7bc39SJason Zhu 
79*37a7bc39SJason Zhu   if (!avb_property_descriptor_validate_and_byteswap(
80*37a7bc39SJason Zhu           (const AvbPropertyDescriptor*)header, &prop_desc)) {
81*37a7bc39SJason Zhu     goto out;
82*37a7bc39SJason Zhu   }
83*37a7bc39SJason Zhu 
84*37a7bc39SJason Zhu   p = (const uint8_t*)header;
85*37a7bc39SJason Zhu   if (p[sizeof(AvbPropertyDescriptor) + prop_desc.key_num_bytes] != 0) {
86*37a7bc39SJason Zhu     avb_error("No terminating NUL byte in key.\n");
87*37a7bc39SJason Zhu     goto out;
88*37a7bc39SJason Zhu   }
89*37a7bc39SJason Zhu 
90*37a7bc39SJason Zhu   if (data->key_size == prop_desc.key_num_bytes) {
91*37a7bc39SJason Zhu     if (avb_memcmp(p + sizeof(AvbPropertyDescriptor),
92*37a7bc39SJason Zhu                    data->key,
93*37a7bc39SJason Zhu                    data->key_size) == 0) {
94*37a7bc39SJason Zhu       data->ret_value = (const char*)(p + sizeof(AvbPropertyDescriptor) +
95*37a7bc39SJason Zhu                                       prop_desc.key_num_bytes + 1);
96*37a7bc39SJason Zhu       data->ret_value_size = prop_desc.value_num_bytes;
97*37a7bc39SJason Zhu       /* Stop iterating. */
98*37a7bc39SJason Zhu       ret = false;
99*37a7bc39SJason Zhu       goto out;
100*37a7bc39SJason Zhu     }
101*37a7bc39SJason Zhu   }
102*37a7bc39SJason Zhu 
103*37a7bc39SJason Zhu out:
104*37a7bc39SJason Zhu   return ret;
105*37a7bc39SJason Zhu }
106*37a7bc39SJason Zhu 
avb_property_lookup(const uint8_t * image_data,size_t image_size,const char * key,size_t key_size,size_t * out_value_size)107*37a7bc39SJason Zhu const char* avb_property_lookup(const uint8_t* image_data,
108*37a7bc39SJason Zhu                                 size_t image_size,
109*37a7bc39SJason Zhu                                 const char* key,
110*37a7bc39SJason Zhu                                 size_t key_size,
111*37a7bc39SJason Zhu                                 size_t* out_value_size) {
112*37a7bc39SJason Zhu   PropertyIteratorData data;
113*37a7bc39SJason Zhu 
114*37a7bc39SJason Zhu   if (key_size == 0) {
115*37a7bc39SJason Zhu     key_size = avb_strlen(key);
116*37a7bc39SJason Zhu   }
117*37a7bc39SJason Zhu 
118*37a7bc39SJason Zhu   data.key = key;
119*37a7bc39SJason Zhu   data.key_size = key_size;
120*37a7bc39SJason Zhu 
121*37a7bc39SJason Zhu   if (avb_descriptor_foreach(
122*37a7bc39SJason Zhu           image_data, image_size, property_lookup_desc_foreach, &data) == 0) {
123*37a7bc39SJason Zhu     if (out_value_size != NULL) {
124*37a7bc39SJason Zhu       *out_value_size = data.ret_value_size;
125*37a7bc39SJason Zhu     }
126*37a7bc39SJason Zhu     return data.ret_value;
127*37a7bc39SJason Zhu   }
128*37a7bc39SJason Zhu 
129*37a7bc39SJason Zhu   if (out_value_size != NULL) {
130*37a7bc39SJason Zhu     *out_value_size = 0;
131*37a7bc39SJason Zhu   }
132*37a7bc39SJason Zhu   return NULL;
133*37a7bc39SJason Zhu }
134*37a7bc39SJason Zhu 
avb_property_lookup_uint64(const uint8_t * image_data,size_t image_size,const char * key,size_t key_size,uint64_t * out_value)135*37a7bc39SJason Zhu bool avb_property_lookup_uint64(const uint8_t* image_data,
136*37a7bc39SJason Zhu                                 size_t image_size,
137*37a7bc39SJason Zhu                                 const char* key,
138*37a7bc39SJason Zhu                                 size_t key_size,
139*37a7bc39SJason Zhu                                 uint64_t* out_value) {
140*37a7bc39SJason Zhu   const char* value;
141*37a7bc39SJason Zhu   bool ret = false;
142*37a7bc39SJason Zhu   uint64_t parsed_val;
143*37a7bc39SJason Zhu   int base;
144*37a7bc39SJason Zhu   int n;
145*37a7bc39SJason Zhu 
146*37a7bc39SJason Zhu   value = avb_property_lookup(image_data, image_size, key, key_size, NULL);
147*37a7bc39SJason Zhu   if (value == NULL) {
148*37a7bc39SJason Zhu     goto out;
149*37a7bc39SJason Zhu   }
150*37a7bc39SJason Zhu 
151*37a7bc39SJason Zhu   base = 10;
152*37a7bc39SJason Zhu   if (avb_memcmp(value, "0x", 2) == 0) {
153*37a7bc39SJason Zhu     base = 16;
154*37a7bc39SJason Zhu     value += 2;
155*37a7bc39SJason Zhu   }
156*37a7bc39SJason Zhu 
157*37a7bc39SJason Zhu   parsed_val = 0;
158*37a7bc39SJason Zhu   for (n = 0; value[n] != '\0'; n++) {
159*37a7bc39SJason Zhu     int c = value[n];
160*37a7bc39SJason Zhu     int digit;
161*37a7bc39SJason Zhu 
162*37a7bc39SJason Zhu     parsed_val *= base;
163*37a7bc39SJason Zhu 
164*37a7bc39SJason Zhu     if (c >= '0' && c <= '9') {
165*37a7bc39SJason Zhu       digit = c - '0';
166*37a7bc39SJason Zhu     } else if (base == 16 && c >= 'a' && c <= 'f') {
167*37a7bc39SJason Zhu       digit = c - 'a' + 10;
168*37a7bc39SJason Zhu     } else if (base == 16 && c >= 'A' && c <= 'F') {
169*37a7bc39SJason Zhu       digit = c - 'A' + 10;
170*37a7bc39SJason Zhu     } else {
171*37a7bc39SJason Zhu       avb_error("Invalid digit.\n");
172*37a7bc39SJason Zhu       goto out;
173*37a7bc39SJason Zhu     }
174*37a7bc39SJason Zhu 
175*37a7bc39SJason Zhu     parsed_val += digit;
176*37a7bc39SJason Zhu   }
177*37a7bc39SJason Zhu 
178*37a7bc39SJason Zhu   ret = true;
179*37a7bc39SJason Zhu   if (out_value != NULL) {
180*37a7bc39SJason Zhu     *out_value = parsed_val;
181*37a7bc39SJason Zhu   }
182*37a7bc39SJason Zhu 
183*37a7bc39SJason Zhu out:
184*37a7bc39SJason Zhu   return ret;
185*37a7bc39SJason Zhu }
186