123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757 |
- /**
- * Copyright (c) 2017 - 2018, Nordic Semiconductor ASA
- *
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without modification,
- * are permitted provided that the following conditions are met:
- *
- * 1. Redistributions of source code must retain the above copyright notice, this
- * list of conditions and the following disclaimer.
- *
- * 2. Redistributions in binary form, except as embedded into a Nordic
- * Semiconductor ASA integrated circuit in a product or a software update for
- * such product, must reproduce the above copyright notice, this list of
- * conditions and the following disclaimer in the documentation and/or other
- * materials provided with the distribution.
- *
- * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
- * contributors may be used to endorse or promote products derived from this
- * software without specific prior written permission.
- *
- * 4. This software, with or without modification, must only be used with a
- * Nordic Semiconductor ASA integrated circuit.
- *
- * 5. Any software provided in binary form under this license must not be reverse
- * engineered, decompiled, modified and/or disassembled.
- *
- * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
- * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
- * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
- * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
- * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
- * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- */
- #include <stdbool.h>
- #include "nrf_dfu_types.h"
- #include "nrf_dfu_settings.h"
- #include "nrf_dfu_utils.h"
- #include "nrf_dfu_flash.h"
- #include "nrf_bootloader_info.h"
- #include "pb.h"
- #include "pb_common.h"
- #include "pb_decode.h"
- #include "dfu-cc.pb.h"
- #include "crc32.h"
- #include "nrf_crypto.h"
- #include "nrf_crypto_shared.h"
- #include "nrf_assert.h"
- #include "nrf_dfu_validation.h"
- #include "nrf_dfu_ver_validation.h"
- #define NRF_LOG_MODULE_NAME nrf_dfu_validation
- #include "nrf_log.h"
- #include "nrf_log_ctrl.h"
- NRF_LOG_MODULE_REGISTER();
- #ifndef DFU_REQUIRES_SOFTDEVICE
- #ifndef BLE_STACK_SUPPORT_REQD
- #define DFU_REQUIRES_SOFTDEVICE 0
- #else
- #define DFU_REQUIRES_SOFTDEVICE 1
- #endif
- #endif
- #define EXT_ERR(err) (nrf_dfu_result_t)((uint32_t)NRF_DFU_RES_CODE_EXT_ERROR + (uint32_t)err)
- /* Whether a complete init command has been received and prevalidated, but the firmware
- * is not yet fully transferred. This value will also be correct after reset.
- */
- static bool m_valid_init_cmd_present = false;
- static dfu_packet_t m_packet = DFU_PACKET_INIT_DEFAULT;
- static uint8_t* m_init_packet_data_ptr = 0;
- static uint32_t m_init_packet_data_len = 0;
- static pb_istream_t m_pb_stream;
- static nrf_crypto_ecdsa_verify_context_t m_verify_context = {0};
- static nrf_crypto_hash_context_t m_hash_context = {0};
- __ALIGN(4) extern const uint8_t pk[64];
- /** @brief Value length structure holding the public key.
- *
- * @details The pk value pointed to is the public key present in dfu_public_key.c
- */
- static nrf_crypto_ecc_public_key_t m_public_key;
- /** @brief Structure to hold a signature
- */
- static nrf_crypto_ecdsa_secp256r1_signature_t m_signature;
- /** @brief Structure to hold the hash for the init packet
- */
- static nrf_crypto_hash_sha256_digest_t m_init_packet_hash;
- /** @brief Structure to hold the hash for the firmware image
- */
- static nrf_crypto_hash_sha256_digest_t m_fw_hash;
- static void pb_decoding_callback(pb_istream_t *str,
- uint32_t tag,
- pb_wire_type_t wire_type,
- void *iter)
- {
- pb_field_iter_t* p_iter = (pb_field_iter_t *) iter;
- // Match the beginning of the init command.
- if (p_iter->pos->ptr == &dfu_init_command_fields[0])
- {
- uint8_t * ptr = (uint8_t *)str->state;
- uint32_t size = str->bytes_left;
- // Remove tag byte.
- ptr++;
- size--;
- // Store the info in init_packet_data.
- m_init_packet_data_ptr = ptr;
- m_init_packet_data_len = size;
- NRF_LOG_DEBUG("PB: Init packet data len: %d", size);
- }
- }
- /** @brief Function for decoding byte stream into variable.
- *
- * @retval true If the stored init command was successfully decoded.
- * @retval false If there was no stored init command, or the decoding failed.
- */
- static bool stored_init_cmd_decode(void)
- {
- m_pb_stream = pb_istream_from_buffer(s_dfu_settings.init_command,
- s_dfu_settings.progress.command_size);
- // Attach our callback to follow the field decoding.
- m_pb_stream.decoding_callback = pb_decoding_callback;
- m_init_packet_data_ptr = NULL;
- m_init_packet_data_len = 0;
- if (!pb_decode(&m_pb_stream, dfu_packet_fields, &m_packet))
- {
- NRF_LOG_ERROR("Handler: Invalid protocol buffer m_pb_stream");
- return false;
- }
- return true;
- }
- void nrf_dfu_validation_init(void)
- {
- ret_code_t err_code;
- uint8_t pk_copy[sizeof(pk)];
-
- // If the command is stored to flash, init command was valid.
- if ( (s_dfu_settings.progress.command_size != 0)
- && stored_init_cmd_decode()
- && (s_dfu_settings.bank_1.image_size != 0))
- {
- m_valid_init_cmd_present = true;
- }
- else
- {
- m_valid_init_cmd_present = false;
- }
-
- err_code = nrf_crypto_init();
- ASSERT(err_code == NRF_SUCCESS);
- UNUSED_PARAMETER(err_code);
-
-
- // Convert public key to big-endian format for use in nrf_crypto.
- nrf_crypto_internal_double_swap_endian(pk_copy, pk, sizeof(pk) / 2);
- err_code = nrf_crypto_ecc_public_key_from_raw(&g_nrf_crypto_ecc_secp256r1_curve_info,
- &m_public_key,
- pk_copy,
- sizeof(pk));
- ASSERT(err_code == NRF_SUCCESS);
- UNUSED_PARAMETER(err_code);
- }
- nrf_dfu_result_t nrf_dfu_validation_init_cmd_create(uint32_t size)
- {
- nrf_dfu_result_t ret_val = NRF_DFU_RES_CODE_SUCCESS;
- if (size == 0)
- {
- ret_val = NRF_DFU_RES_CODE_INVALID_PARAMETER;
- }
- else if (size > INIT_COMMAND_MAX_SIZE)
- {
- ret_val = NRF_DFU_RES_CODE_INSUFFICIENT_RESOURCES;
- }
- else
- {
- // Set DFU to uninitialized.
- m_valid_init_cmd_present = false;
- // Reset all progress.
- s_dfu_settings.write_offset = 0;
- memset(&s_dfu_settings.progress, 0x00, sizeof(dfu_progress_t));
- // Set the init command size.
- s_dfu_settings.progress.command_size = size;
- }
- return ret_val;
- }
- nrf_dfu_result_t nrf_dfu_validation_init_cmd_append(uint8_t const * p_data, uint32_t length)
- {
- nrf_dfu_result_t ret_val = NRF_DFU_RES_CODE_SUCCESS;
- if ((length + s_dfu_settings.progress.command_offset) > s_dfu_settings.progress.command_size)
- {
- NRF_LOG_ERROR("Init command larger than expected.");
- ret_val = NRF_DFU_RES_CODE_INVALID_PARAMETER;
- }
- else
- {
- // Copy the received data to RAM, update offset and calculate CRC.
- memcpy(&s_dfu_settings.init_command[s_dfu_settings.progress.command_offset],
- p_data,
- length);
- s_dfu_settings.progress.command_offset += length;
- s_dfu_settings.progress.command_crc = crc32_compute(p_data,
- length,
- &s_dfu_settings.progress.command_crc);
- }
- return ret_val;
- }
- void nrf_dfu_validation_init_cmd_status_get(uint32_t * p_offset,
- uint32_t * p_crc,
- uint32_t * p_max_size)
- {
- *p_offset = s_dfu_settings.progress.command_offset;
- *p_crc = s_dfu_settings.progress.command_crc;
- *p_max_size = INIT_COMMAND_MAX_SIZE;
- }
- bool nrf_dfu_validation_init_cmd_present(void)
- {
- return m_valid_init_cmd_present;
- }
- // Function determines if init command signature is obligatory.
- static bool signature_required(dfu_fw_type_t fw_type_to_be_updated)
- {
- bool result = true;
- if ((!DFU_REQUIRES_SOFTDEVICE && (fw_type_to_be_updated == DFU_FW_TYPE_SOFTDEVICE)) ||
- (fw_type_to_be_updated == DFU_FW_TYPE_APPLICATION))
- {
- result = NRF_DFU_REQUIRE_SIGNED_APP_UPDATE;
- }
- return result;
- }
- // Function to perform signature check if required.
- static nrf_dfu_result_t signature_check(dfu_fw_type_t fw_type,
- dfu_signature_type_t signature_type,
- dfu_signed_command_signature_t const * p_signature)
- {
- ret_code_t err_code;
- size_t hash_len = NRF_CRYPTO_HASH_SIZE_SHA256;
-
- if (!signature_required(fw_type))
- {
- return NRF_DFU_RES_CODE_SUCCESS;
- }
- NRF_LOG_INFO("Signature required. Checking signature.")
- if (p_signature == NULL)
- {
- NRF_LOG_WARNING("No signature found.");
- return EXT_ERR(NRF_DFU_EXT_ERROR_SIGNATURE_MISSING);
- }
- if (signature_type != DFU_SIGNATURE_TYPE_ECDSA_P256_SHA256)
- {
- NRF_LOG_INFO("Invalid signature type");
- return EXT_ERR(NRF_DFU_EXT_ERROR_WRONG_SIGNATURE_TYPE);
- }
- NRF_LOG_INFO("Calculating init packet hash (init packet len: %d)", m_init_packet_data_len);
- err_code = nrf_crypto_hash_calculate(&m_hash_context,
- &g_nrf_crypto_hash_sha256_info,
- m_init_packet_data_ptr,
- m_init_packet_data_len,
- m_init_packet_hash,
- &hash_len);
- if (err_code != NRF_SUCCESS)
- {
- return NRF_DFU_RES_CODE_OPERATION_FAILED;
- }
- if (sizeof(m_signature) != p_signature->size)
- {
- return NRF_DFU_RES_CODE_OPERATION_FAILED;
- }
- // Prepare the signature received over the air.
- memcpy(m_signature, p_signature->bytes, p_signature->size);
- // Calculate the signature.
- NRF_LOG_INFO("Verify signature");
- // The signature is in little-endian format. Change it to big-endian format for nrf_crypto use.
- nrf_crypto_internal_double_swap_endian_in_place(m_signature, sizeof(m_signature) / 2);
- err_code = nrf_crypto_ecdsa_verify(&m_verify_context,
- &m_public_key,
- m_init_packet_hash,
- hash_len,
- m_signature,
- sizeof(m_signature));
- if (err_code != NRF_SUCCESS)
- {
- NRF_LOG_ERROR("Signature failed (err_code: 0x%x)", err_code);
- NRF_LOG_DEBUG("Signature:");
- NRF_LOG_HEXDUMP_DEBUG(m_signature, sizeof(m_signature));
- NRF_LOG_DEBUG("Hash:");
- NRF_LOG_HEXDUMP_DEBUG(m_init_packet_hash, hash_len);
- NRF_LOG_DEBUG("Public Key:");
- NRF_LOG_HEXDUMP_DEBUG(pk, sizeof(pk));
- NRF_LOG_FLUSH();
- return NRF_DFU_RES_CODE_INVALID_OBJECT;
- }
- NRF_LOG_INFO("Image verified");
- return NRF_DFU_RES_CODE_SUCCESS;
- }
- // Function to calculate the total size of the firmware(s) in the update.
- static nrf_dfu_result_t update_data_size_get(dfu_init_command_t const * p_init, uint32_t * p_size)
- {
- nrf_dfu_result_t ret_val = EXT_ERR(NRF_DFU_EXT_ERROR_INIT_COMMAND_INVALID);
- uint32_t fw_sz = 0;
- if ((p_init->type == DFU_FW_TYPE_APPLICATION) && (p_init->has_app_size == true))
- {
- fw_sz = p_init->app_size;
- }
- else
- {
- if ((p_init->type & DFU_FW_TYPE_SOFTDEVICE) && (p_init->has_sd_size == true))
- {
- fw_sz = p_init->sd_size;
- }
- if ((p_init->type & DFU_FW_TYPE_BOOTLOADER) && (p_init->has_bl_size == true))
- {
- if (p_init->bl_size <= BOOTLOADER_SIZE)
- {
- fw_sz += p_init->bl_size;
- }
- else
- {
- NRF_LOG_ERROR("BL size (%d) over limit (%d)", p_init->bl_size, BOOTLOADER_SIZE);
- fw_sz = 0;
- ret_val = NRF_DFU_RES_CODE_INSUFFICIENT_RESOURCES;
- }
- }
- }
- if (fw_sz)
- {
- *p_size = fw_sz;
- ret_val = NRF_DFU_RES_CODE_SUCCESS;
- }
- else
- {
- NRF_LOG_ERROR("Init packet does not contain valid firmware size");
- }
- return ret_val;
- }
- /**
- * @brief Function to check if single bank update should be used.
- *
- * @param new_fw_type Firmware type.
- */
- static bool use_single_bank(dfu_fw_type_t new_fw_type)
- {
- bool result = false;
- if (((new_fw_type == DFU_FW_TYPE_APPLICATION) || (new_fw_type == DFU_FW_TYPE_SOFTDEVICE)) &&
- NRF_DFU_SINGLE_BANK_APP_UPDATES)
- {
- result = true;
- }
- return result;
- }
- // Function to determine whether the new firmware needs a SoftDevice to be present.
- static bool update_requires_softdevice(dfu_init_command_t const * p_init)
- {
- return ((p_init->sd_req_count > 0) && (p_init->sd_req[0] != SD_REQ_APP_OVERWRITES_SD));
- }
- // Function to determine whether the SoftDevice can be removed during the update or not.
- static bool keep_softdevice(dfu_init_command_t const * p_init)
- {
- UNUSED_PARAMETER(p_init); // It's unused when DFU_REQUIRES_SOFTDEVICE is true.
- return DFU_REQUIRES_SOFTDEVICE || update_requires_softdevice(p_init);
- }
- /**@brief Function to determine where to temporarily store the incoming firmware.
- * This also checks whether the update will fit, and deletes existing
- * firmware to make room for the new firmware.
- *
- * @param[in] p_init Init command.
- * @param[in] fw_size The size of the incoming firmware.
- * @param[out] p_addr The address at which to initially store the firmware.
- *
- * @retval NRF_DFU_RES_CODE_SUCCESS If the size check passed and
- * an address was found.
- * @retval NRF_DFU_RES_CODE_INSUFFICIENT_RESOURCES If the size check failed.
- */
- static nrf_dfu_result_t update_data_addr_get(dfu_init_command_t const * p_init,
- uint32_t fw_size,
- uint32_t * p_addr)
- {
- nrf_dfu_result_t ret_val = NRF_DFU_RES_CODE_SUCCESS;
- ret_code_t err_code = nrf_dfu_cache_prepare(fw_size,
- use_single_bank(p_init->type),
- NRF_DFU_FORCE_DUAL_BANK_APP_UPDATES,
- keep_softdevice(p_init));
- if (err_code != NRF_SUCCESS)
- {
- NRF_LOG_ERROR("Can't find room for update");
- ret_val = NRF_DFU_RES_CODE_INSUFFICIENT_RESOURCES;
- }
- else
- {
- *p_addr = nrf_dfu_bank1_start_addr();
- NRF_LOG_DEBUG("Write address set to 0x%08x", *p_addr);
- }
- return ret_val;
- }
- nrf_dfu_result_t nrf_dfu_validation_init_cmd_execute(uint32_t * p_dst_data_addr,
- uint32_t * p_data_len)
- {
- nrf_dfu_result_t ret_val = NRF_DFU_RES_CODE_SUCCESS;
- if (s_dfu_settings.progress.command_offset != s_dfu_settings.progress.command_size)
- {
- // The object wasn't the right (requested) size.
- NRF_LOG_ERROR("Execute with faulty offset");
- ret_val = NRF_DFU_RES_CODE_OPERATION_NOT_PERMITTED;
- }
- else if (m_valid_init_cmd_present)
- {
- *p_dst_data_addr = nrf_dfu_bank1_start_addr();
- *p_data_len = s_dfu_settings.bank_1.image_size;
- ret_val = NRF_DFU_RES_CODE_SUCCESS;
- }
- else if (stored_init_cmd_decode() &&
- (m_packet.has_signed_command || m_packet.has_command))
- {
- dfu_command_t const * p_command = &m_packet.command;
- dfu_signature_type_t signature_type = (dfu_signature_type_t) 0; // Placeholder.
- dfu_signed_command_signature_t * p_signature = NULL;
- *p_dst_data_addr = 0;
- *p_data_len = 0;
- if (m_packet.has_signed_command)
- {
- p_command = &m_packet.signed_command.command;
- signature_type = m_packet.signed_command.signature_type;
- p_signature = &m_packet.signed_command.signature;
- }
- // Validate signature.
- ret_val = signature_check(p_command->init.type, signature_type, p_signature);
- // Validate versions.
- if (ret_val == NRF_DFU_RES_CODE_SUCCESS)
- {
- ret_val = nrf_dfu_ver_validation_check(&p_command->init);
- if (ret_val == NRF_DFU_RES_CODE_SUCCESS)
- {
- m_valid_init_cmd_present = true;
- }
- }
- // Get size of binary.
- if (ret_val == NRF_DFU_RES_CODE_SUCCESS)
- {
- ret_val = update_data_size_get(&p_command->init, p_data_len);
- }
- //Get address where to flash the binary.
- if (ret_val == NRF_DFU_RES_CODE_SUCCESS)
- {
- ret_val = update_data_addr_get(&p_command->init, *p_data_len, p_dst_data_addr);
- }
- }
- else
- {
- NRF_LOG_ERROR("Failed to decode init packet");
- ret_val = NRF_DFU_RES_CODE_INVALID_OBJECT;
- }
- return ret_val;
- }
- // Function to check the hash received in the init command against the received firmware.
- static bool fw_hash_ok(dfu_init_command_t const * p_init, uint32_t fw_start_addr, uint32_t fw_size)
- {
- ret_code_t err_code;
- bool result = true;
- uint8_t hash_be[NRF_CRYPTO_HASH_SIZE_SHA256];
- size_t hash_len = NRF_CRYPTO_HASH_SIZE_SHA256;
- ASSERT(p_init != NULL);
-
- // Convert to hash to big-endian format for use in nrf_crypto.
- nrf_crypto_internal_swap_endian(hash_be,
- (uint8_t *)p_init->hash.hash.bytes,
- NRF_CRYPTO_HASH_SIZE_SHA256);
- NRF_LOG_DEBUG("Hash verification. Firmware start address: 0x%x, size: 0x%x",
- fw_start_addr,
- fw_size);
- err_code = nrf_crypto_hash_calculate(&m_hash_context,
- &g_nrf_crypto_hash_sha256_info,
- (uint8_t*)fw_start_addr,
- fw_size,
- m_fw_hash,
- &hash_len);
-
- if (err_code != NRF_SUCCESS)
- {
- NRF_LOG_ERROR("Could not run hash verification (err_code 0x%x).", err_code);
- result = false;
- }
- else if (memcmp(m_fw_hash, hash_be, NRF_CRYPTO_HASH_SIZE_SHA256) != 0)
- {
- NRF_LOG_WARNING("Hash verification failed.");
- NRF_LOG_DEBUG("Expected FW hash:")
- NRF_LOG_HEXDUMP_DEBUG(p_init->hash.hash.bytes, NRF_CRYPTO_HASH_SIZE_SHA256);
- NRF_LOG_DEBUG("Actual FW hash:")
- NRF_LOG_HEXDUMP_DEBUG(m_fw_hash, NRF_CRYPTO_HASH_SIZE_SHA256);
- NRF_LOG_FLUSH();
- result = false;
- }
- return result;
- }
- // Function to check whether the update contains a SoftDevice and, if so, if it is of a different
- // major version than the existing SoftDevice.
- static bool is_major_softdevice_update(uint32_t new_sd_addr)
- {
- // True if there is no SD right now, but there is a new one coming. This counts as a major update.
- bool result = !SD_PRESENT && (SD_MAGIC_NUMBER_GET(new_sd_addr) == SD_MAGIC_NUMBER);
- if (SD_PRESENT && (SD_MAGIC_NUMBER_GET(new_sd_addr) == SD_MAGIC_NUMBER))
- {
- // Both SoftDevices are present.
- uint32_t current_SD_major = SD_MAJOR_VERSION_EXTRACT(SD_VERSION_GET(MBR_SIZE));
- uint32_t new_SD_major = SD_MAJOR_VERSION_EXTRACT(SD_VERSION_GET(new_sd_addr));
- result = (current_SD_major != new_SD_major);
- NRF_LOG_INFO("SoftDevice update is a %s version update. Current: %d. New: %d.",
- result ? "major" : "minor",
- current_SD_major,
- new_SD_major);
- }
- return result;
- }
- /**@brief Validate the SoftDevice size and magic number in structure found at 0x2000 in received SoftDevice.
- *
- * @param[in] sd_start_addr Start address of received SoftDevice.
- * @param[in] sd_size Size of received SoftDevice in bytes.
- */
- static bool softdevice_info_ok(uint32_t sd_start_addr, uint32_t sd_size)
- {
- bool result = true;
- if (SD_MAGIC_NUMBER_GET(sd_start_addr) != SD_MAGIC_NUMBER)
- {
- NRF_LOG_ERROR("The SoftDevice does not contain the magic number identifying it as a SoftDevice.");
- result = false;
- }
- else if (SD_SIZE_GET(sd_start_addr) < ALIGN_TO_PAGE(sd_size + MBR_SIZE))
- {
- // The size in the info struct should be rounded up to a page boundary
- // and be larger than the actual size + the size of the MBR.
- NRF_LOG_ERROR("The SoftDevice size in the info struct is too small compared with the size reported in the init command.");
- result = false;
- }
- return result;
- }
- static void postvalidate_app(dfu_init_command_t * p_init)
- {
- s_dfu_settings.bank_1.bank_code = NRF_DFU_BANK_VALID_APP;
- NRF_LOG_DEBUG("Invalidating old application in bank 0.");
- s_dfu_settings.bank_0.bank_code = NRF_DFU_BANK_INVALID;
- if (!DFU_REQUIRES_SOFTDEVICE && !update_requires_softdevice(p_init))
- {
- // App does not need SD, so it should be placed where SD is.
- nrf_dfu_softdevice_invalidate();
- }
- if (!NRF_DFU_DEBUG ||
- (NRF_DFU_DEBUG && (p_init->has_is_debug == false || p_init->is_debug == false)))
- {
- s_dfu_settings.app_version = p_init->fw_version;
- }
- }
- // Function to check a received SoftDevice or Bootloader firmware, or both,
- // before it is copied into place.
- static bool postvalidate_sd_bl(dfu_init_command_t * p_init,
- bool with_sd,
- bool with_bl,
- uint32_t start_addr)
- {
- if (with_sd)
- {
- if (!softdevice_info_ok(start_addr, p_init->sd_size))
- {
- return false;
- }
- if (is_major_softdevice_update(start_addr))
- {
- NRF_LOG_WARNING("Invalidating app because it is incompatible with the SoftDevice.");
- if (DFU_REQUIRES_SOFTDEVICE && !with_bl)
- {
- NRF_LOG_ERROR("Major SD update but no BL. Abort to avoid incapacitating the BL.");
- return false;
- }
- // Invalidate app since it may not be compatible with new SD.
- nrf_dfu_bank_invalidate(&s_dfu_settings.bank_0);
- }
- // Mark the update as valid.
- s_dfu_settings.bank_1.bank_code = with_bl ? NRF_DFU_BANK_VALID_SD_BL
- : NRF_DFU_BANK_VALID_SD;
- s_dfu_settings.sd_size = p_init->sd_size;
- }
- else
- {
- s_dfu_settings.bank_1.bank_code = NRF_DFU_BANK_VALID_BL;
- }
- if (with_bl &&
- (!NRF_DFU_DEBUG ||
- (NRF_DFU_DEBUG && (p_init->has_is_debug == false || p_init->is_debug == false))))
- {
- // If the update contains a bootloader, update the version.
- // Unless the update is a debug packet.
- s_dfu_settings.bootloader_version = p_init->fw_version;
- }
- return true;
- }
- nrf_dfu_result_t nrf_dfu_validation_post_data_execute(uint32_t src_addr, uint32_t data_len)
- {
- nrf_dfu_result_t ret_val = NRF_DFU_RES_CODE_SUCCESS;
- dfu_init_command_t * p_init = m_packet.has_signed_command ?
- &m_packet.signed_command.command.init : &m_packet.command.init;
- if (!fw_hash_ok(p_init, src_addr, data_len))
- {
- ret_val = EXT_ERR(NRF_DFU_EXT_ERROR_VERIFICATION_FAILED);
- }
- else
- {
- if (p_init->type == DFU_FW_TYPE_APPLICATION)
- {
- postvalidate_app(p_init);
- }
- else
- {
- bool with_sd = p_init->type & DFU_FW_TYPE_SOFTDEVICE;
- bool with_bl = p_init->type & DFU_FW_TYPE_BOOTLOADER;
- if (!postvalidate_sd_bl(p_init, with_sd, with_bl, src_addr))
- {
- ret_val = NRF_DFU_RES_CODE_INVALID_OBJECT;
- if (with_sd && !DFU_REQUIRES_SOFTDEVICE &&
- (src_addr == nrf_dfu_softdevice_start_address()))
- {
- nrf_dfu_softdevice_invalidate();
- }
- }
- }
- }
- if (ret_val == NRF_DFU_RES_CODE_SUCCESS)
- {
- // Store CRC32 for image.
- s_dfu_settings.bank_1.image_crc = s_dfu_settings.progress.firmware_image_crc;
- s_dfu_settings.bank_1.image_size = data_len;
- }
- else
- {
- nrf_dfu_bank_invalidate(&s_dfu_settings.bank_1);
- }
- // Set the progress to zero and remove the last command.
- memset(&s_dfu_settings.progress, 0, sizeof(dfu_progress_t));
- memset(s_dfu_settings.init_command, 0xFF, DFU_SIGNED_COMMAND_SIZE);
- s_dfu_settings.write_offset = 0;
- s_dfu_settings.progress.update_start_address = src_addr;
- return ret_val;
- }
|