mirror of
https://github.com/bluekitchen/btstack.git
synced 2025-01-01 00:28:18 +00:00
121 lines
4.2 KiB
C
121 lines
4.2 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 MATTHIAS RINGWALD 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 MATTHIAS
|
|
* RINGWALD 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_memory.c -- volatile test environment that provides just two memory banks
|
|
*
|
|
*/
|
|
|
|
#define BTSTACK_FILE__ "hal_flash_bank_memory.c"
|
|
|
|
#include "hal_flash_bank.h"
|
|
#include "hal_flash_bank_memory.h"
|
|
#include "btstack_debug.h"
|
|
|
|
#include "stdint.h"
|
|
#include "string.h"
|
|
|
|
#ifdef BTSTACK_TEST
|
|
#include "stdio.h"
|
|
#include <stdlib.h> // exit(..)
|
|
#endif
|
|
|
|
static uint32_t hal_flash_bank_memory_get_size(void * context){
|
|
hal_flash_bank_memory_t * self = (hal_flash_bank_memory_t *) context;
|
|
return self->bank_size;
|
|
}
|
|
|
|
static uint32_t hal_flash_bank_memory_get_alignment(void * context){
|
|
UNUSED(context);
|
|
return 1;
|
|
}
|
|
|
|
static void hal_flash_bank_memory_erase(void * context, int bank){
|
|
hal_flash_bank_memory_t * self = (hal_flash_bank_memory_t *) context;
|
|
if (bank > 1) return;
|
|
memset(self->banks[bank], 0xff, self->bank_size);
|
|
}
|
|
|
|
static void hal_flash_bank_memory_read(void * context, int bank, uint32_t offset, uint8_t * buffer, uint32_t size){
|
|
hal_flash_bank_memory_t * self = (hal_flash_bank_memory_t *) context;
|
|
|
|
// log_info("read offset %u, len %u", offset, size);
|
|
|
|
if (bank > 1) return;
|
|
if (offset > self->bank_size) return;
|
|
if ((offset + size) > self->bank_size) return;
|
|
|
|
memcpy(buffer, &self->banks[bank][offset], size);
|
|
}
|
|
|
|
static void hal_flash_bank_memory_write(void * context, int bank, uint32_t offset, const uint8_t * data, uint32_t size){
|
|
hal_flash_bank_memory_t * self = (hal_flash_bank_memory_t *) context;
|
|
|
|
log_info("write offset %u, len %u", offset, size);
|
|
log_info_hexdump(data, size);
|
|
|
|
if (bank > 1) return;
|
|
if (offset > self->bank_size) return;
|
|
if ((offset + size) > self->bank_size) return;
|
|
|
|
int i;
|
|
for (i=0;i<size;i++){
|
|
// write 0xff doesn't change anything
|
|
if (data[i] == 0xff) continue;
|
|
// writing something other than 0x00 is only allowed once
|
|
if (self->banks[bank][offset] != 0xff && data[i] != 0x00){
|
|
log_error("Error: offset %u written twice. Data: 0x%02x!", offset+i, data[i]);
|
|
} else {
|
|
self->banks[bank][offset++] = data[i];
|
|
}
|
|
}
|
|
}
|
|
|
|
static const hal_flash_bank_t hal_flash_bank_memory_instance = {
|
|
/* uint32_t (*get_size)(..) */ &hal_flash_bank_memory_get_size,
|
|
/* uint32_t (*get_alignment)(..); */ &hal_flash_bank_memory_get_alignment,
|
|
/* void (*erase)(..); */ &hal_flash_bank_memory_erase,
|
|
/* void (*read)(..); */ &hal_flash_bank_memory_read,
|
|
/* void (*write)(..); */ &hal_flash_bank_memory_write,
|
|
};
|
|
|
|
/**
|
|
* Initialize instance
|
|
*/
|
|
const hal_flash_bank_t * hal_flash_bank_memory_init_instance(hal_flash_bank_memory_t * self, uint8_t * storage, uint32_t storage_size){
|
|
self->bank_size = storage_size / 2;
|
|
self->banks[0] = storage;
|
|
self->banks[1] = &storage[self->bank_size];
|
|
memset(storage, 0xff, storage_size);
|
|
return &hal_flash_bank_memory_instance;
|
|
}
|
|
|