| // SPDX-License-Identifier: GPL-2.0-or-later |
| /* |
| * Copyright (c) 2024, Linaro Limited |
| */ |
| |
| #include <fwu.h> |
| #include <fwu_mdata.h> |
| #include <log.h> |
| |
| #include <linux/types.h> |
| |
| #define FWU_MDATA_VERSION 0x2U |
| |
| static inline struct fwu_fw_store_desc *fwu_get_fw_desc(struct fwu_mdata *mdata) |
| { |
| return (struct fwu_fw_store_desc *)((u8 *)mdata + sizeof(*mdata)); |
| } |
| |
| static uint32_t fwu_check_trial_state(struct fwu_mdata *mdata, uint32_t bank) |
| { |
| return mdata->bank_state[bank] == FWU_BANK_VALID ? 1 : 0; |
| } |
| |
| static void fwu_data_init(void) |
| { |
| int i; |
| size_t image_info_size; |
| void *dst_img_info, *src_img_info; |
| struct fwu_data *data = fwu_get_data(); |
| struct fwu_mdata *mdata = data->fwu_mdata; |
| |
| data->crc32 = mdata->crc32; |
| data->version = mdata->version; |
| data->active_index = mdata->active_index; |
| data->previous_active_index = mdata->previous_active_index; |
| data->metadata_size = mdata->metadata_size; |
| fwu_plat_get_bootidx(&data->boot_index); |
| data->trial_state = fwu_check_trial_state(mdata, data->boot_index); |
| |
| data->num_banks = fwu_get_fw_desc(mdata)->num_banks; |
| data->num_images = fwu_get_fw_desc(mdata)->num_images; |
| |
| for (i = 0; i < 4; i++) { |
| data->bank_state[i] = mdata->bank_state[i]; |
| } |
| |
| image_info_size = sizeof(data->fwu_images); |
| src_img_info = &fwu_get_fw_desc(mdata)->img_entry[0]; |
| dst_img_info = &data->fwu_images[0]; |
| |
| memcpy(dst_img_info, src_img_info, image_info_size); |
| } |
| |
| static int fwu_mdata_sanity_checks(void) |
| { |
| uint8_t num_banks; |
| uint16_t num_images; |
| struct fwu_data *data = fwu_get_data(); |
| struct fwu_mdata *mdata = data->fwu_mdata; |
| |
| if (mdata->version != FWU_MDATA_VERSION) { |
| log_err("FWU metadata version %u. Expected value of %u\n", |
| mdata->version, FWU_MDATA_VERSION); |
| return -EINVAL; |
| } |
| |
| if (!mdata->desc_offset) { |
| log_err("No image information provided with the Metadata. "); |
| log_err("Image information expected in the metadata\n"); |
| return -EINVAL; |
| } |
| |
| if (mdata->desc_offset != 0x20) { |
| log_err("Descriptor Offset(0x%x) in the FWU Metadata not equal to 0x20\n", |
| mdata->desc_offset); |
| return -EINVAL; |
| } |
| |
| num_banks = fwu_get_fw_desc(mdata)->num_banks; |
| num_images = fwu_get_fw_desc(mdata)->num_images; |
| |
| if (num_banks != CONFIG_FWU_NUM_BANKS) { |
| log_err("Number of Banks(%u) in FWU Metadata different from the configured value(%d)", |
| num_banks, CONFIG_FWU_NUM_BANKS); |
| return -EINVAL; |
| } |
| |
| if (num_images != CONFIG_FWU_NUM_IMAGES_PER_BANK) { |
| log_err("Number of Images(%u) in FWU Metadata different from the configured value(%d)", |
| num_images, CONFIG_FWU_NUM_IMAGES_PER_BANK); |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| static int fwu_bank_state_update(bool trial_state, uint32_t bank) |
| { |
| int ret; |
| struct fwu_data *data = fwu_get_data(); |
| struct fwu_mdata *mdata = data->fwu_mdata; |
| |
| mdata->bank_state[bank] = data->bank_state[bank] = trial_state ? |
| FWU_BANK_VALID : FWU_BANK_ACCEPTED; |
| |
| ret = fwu_sync_mdata(mdata, BOTH_PARTS); |
| if (ret) |
| log_err("Unable to set bank_state for bank %u\n", bank); |
| else |
| data->trial_state = trial_state; |
| |
| return ret; |
| } |
| |
| static int fwu_trial_state_start(uint update_index) |
| { |
| int ret; |
| |
| ret = fwu_trial_state_ctr_start(); |
| if (ret) |
| return ret; |
| |
| ret = fwu_bank_state_update(1, update_index); |
| if (ret) |
| return ret; |
| |
| return 0; |
| } |
| |
| /** |
| * fwu_populate_mdata_image_info() - Populate the image information |
| * of the metadata |
| * @data: Version agnostic FWU metadata information |
| * |
| * Populate the image information in the FWU metadata by copying it |
| * from the version agnostic structure. This is done before the |
| * metadata gets written to the storage media. |
| * |
| * Return: None |
| */ |
| void fwu_populate_mdata_image_info(struct fwu_data *data) |
| { |
| size_t image_info_size; |
| struct fwu_mdata *mdata = data->fwu_mdata; |
| void *dst_img_info, *src_img_info; |
| |
| image_info_size = sizeof(data->fwu_images); |
| dst_img_info = &fwu_get_fw_desc(mdata)->img_entry[0]; |
| src_img_info = &data->fwu_images[0]; |
| |
| memcpy(dst_img_info, src_img_info, image_info_size); |
| } |
| |
| /** |
| * fwu_state_machine_updates() - Update FWU state of the platform |
| * @trial_state: Is platform transitioning into Trial State |
| * @update_index: Bank number to which images have been updated |
| * |
| * On successful completion of updates, transition the platform to |
| * either Trial State or Regular State. |
| * |
| * To transition the platform to Trial State, start the |
| * TrialStateCtr counter, followed by setting the value of bank_state |
| * field of the metadata to Valid state(applicable only in version 2 |
| * of metadata). |
| * |
| * In case, the platform is to transition directly to Regular State, |
| * update the bank_state field of the metadata to Accepted |
| * state(applicable only in version 2 of metadata). |
| * |
| * Return: 0 if OK, -ve on error |
| */ |
| int fwu_state_machine_updates(bool trial_state, uint32_t update_index) |
| { |
| return trial_state ? fwu_trial_state_start(update_index) : |
| fwu_bank_state_update(0, update_index); |
| } |
| |
| /** |
| * fwu_get_mdata_size() - Get the FWU metadata size |
| * @mdata_size: Size of the metadata structure |
| * |
| * Get the size of the FWU metadata from the structure. This is later used |
| * to allocate memory for the structure. |
| * |
| * Return: 0 if OK, -ve on error |
| */ |
| int fwu_get_mdata_size(uint32_t *mdata_size) |
| { |
| int ret = 0; |
| struct fwu_mdata mdata = { 0 }; |
| struct fwu_data *data = fwu_get_data(); |
| struct udevice *fwu_dev = fwu_get_dev(); |
| |
| if (data->metadata_size) { |
| *mdata_size = data->metadata_size; |
| return 0; |
| } |
| |
| ret = fwu_read_mdata(fwu_dev, &mdata, 1, |
| sizeof(struct fwu_mdata)); |
| if (ret) { |
| log_err("FWU metadata read failed\n"); |
| return ret; |
| } |
| |
| *mdata_size = mdata.metadata_size; |
| if (!*mdata_size) |
| return -EINVAL; |
| |
| return 0; |
| } |
| |
| /** |
| * fwu_init() - FWU specific initialisations |
| * |
| * Carry out some FWU specific initialisations including allocation |
| * of memory for the metadata copies, and reading the FWU metadata |
| * copies into the allocated memory. The metadata fields are then |
| * copied into a version agnostic structure. |
| * |
| * Return: 0 if OK, -ve on error |
| */ |
| int fwu_init(void) |
| { |
| int ret; |
| struct fwu_mdata mdata = { 0 }; |
| struct udevice *fwu_dev = fwu_get_dev(); |
| |
| /* |
| * First we read only the top level structure |
| * and get the size of the complete structure. |
| */ |
| ret = fwu_read_mdata(fwu_dev, &mdata, 1, |
| sizeof(struct fwu_mdata)); |
| if (ret) { |
| log_err("FWU metadata read failed\n"); |
| return ret; |
| } |
| |
| ret = fwu_mdata_copies_allocate(mdata.metadata_size); |
| if (ret) |
| return ret; |
| |
| /* |
| * Now read the entire structure, both copies, and |
| * validate that the copies. |
| */ |
| ret = fwu_get_mdata(NULL); |
| if (ret) |
| return ret; |
| |
| ret = fwu_mdata_sanity_checks(); |
| if (ret) |
| return ret; |
| |
| fwu_data_init(); |
| |
| return 0; |
| } |