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