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 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 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 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 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