btstack/port/msp432p401lp-cc256x/hal_flash_bank_msp432.c
2021-11-02 09:31:00 +01:00

122 lines
4.8 KiB
C

/*
* Copyright (C) 2017 BlueKitchen GmbH
*
* 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 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 the copyright holders nor the names of
* contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN
* GMBH 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.
*
*/
/*
* hal_flash_bank_stm32.c
*
* HAL abstraction for Flash memory that can be written anywhere
* after being erased
*/
#include <stdint.h>
#include <string.h> // memcpy
#include "hal_flash_bank_msp432.h"
#include "driverlib.h"
#include "btstack_defines.h"
static uint32_t hal_flash_bank_msp432_get_size(void * context){
hal_flash_bank_msp432_t * self = (hal_flash_bank_msp432_t *) context;
return self->sector_size;
}
static uint32_t hal_flash_bank_memory_msp432_get_alignment(void * context){
UNUSED(context);
return 4;
}
static void hal_flash_bank_msp432_erase(void * context, int bank){
hal_flash_bank_msp432_t * self = (hal_flash_bank_msp432_t *) context;
if (bank > 1) return;
/* Unprotecting sector */
MAP_FlashCtl_unprotectSector(FLASH_MAIN_MEMORY_SPACE_BANK1,self->sectors[bank]);
/* Trying to erase the sector. Within this function, the API will
automatically try to erase the maximum number of tries. If it fails,
trap in an infinite loop */
if(!MAP_FlashCtl_eraseSector(self->banks[bank]))
while(1);
/* Setting the sector back to protected */
MAP_FlashCtl_protectSector(FLASH_MAIN_MEMORY_SPACE_BANK1,self->sectors[bank]);
}
static void hal_flash_bank_msp432_read(void * context, int bank, uint32_t offset, uint8_t * buffer, uint32_t size){
hal_flash_bank_msp432_t * self = (hal_flash_bank_msp432_t *) context;
if (bank > 1) return;
if (offset > self->sector_size) return;
if ((offset + size) > self->sector_size) return;
memcpy(buffer, ((uint8_t *) self->banks[bank]) + offset, size);
}
static void hal_flash_bank_msp432_write(void * context, int bank, uint32_t offset, const uint8_t * data, uint32_t size){
hal_flash_bank_msp432_t * self = (hal_flash_bank_msp432_t *) context;
if (bank > 1) return;
if (offset > self->sector_size) return;
if ((offset + size) > self->sector_size) return;
/* Unprotecting sector */
MAP_FlashCtl_unprotectSector(FLASH_MAIN_MEMORY_SPACE_BANK1,self->sectors[bank]);
/* Trying to program the memory. Within this function, the API will
automatically try to program the maximum number of tries. If it fails,
trap inside an infinite loop */
if(!MAP_FlashCtl_programMemory( (void *) data,
(void*) ((uint8_t *) self->banks[bank]) + offset, size))
while(1);
/* Setting the sector back to protected */
MAP_FlashCtl_protectSector(FLASH_MAIN_MEMORY_SPACE_BANK1,self->sectors[bank]);
}
static const hal_flash_bank_t hal_flash_bank_msp432_impl = {
/* uint32_t (*get_size)() */ &hal_flash_bank_msp432_get_size,
/* uint32_t (*get_alignment)(..); */ &hal_flash_bank_memory_msp432_get_alignment,
/* void (*erase)(..); */ &hal_flash_bank_msp432_erase,
/* void (*read)(..); */ &hal_flash_bank_msp432_read,
/* void (*write)(..); */ &hal_flash_bank_msp432_write,
};
const hal_flash_bank_t * hal_flash_bank_msp432_init_instance(hal_flash_bank_msp432_t * context, uint32_t sector_size,
uint32_t bank_0_sector, uint32_t bank_1_sector, uintptr_t bank_0_addr, uintptr_t bank_1_addr){
context->sector_size = sector_size;
context->sectors[0] = bank_0_sector;
context->sectors[1] = bank_1_sector;
context->banks[0] = bank_0_addr;
context->banks[1] = bank_1_addr;
return &hal_flash_bank_msp432_impl;
}