初始版本
This commit is contained in:
244
components/libraries/block_dev/ram/nrf_block_dev_ram.c
Normal file
244
components/libraries/block_dev/ram/nrf_block_dev_ram.c
Normal file
@@ -0,0 +1,244 @@
|
||||
/**
|
||||
* Copyright (c) 2016 - 2020, 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 "sdk_common.h"
|
||||
#if NRF_MODULE_ENABLED(NRF_BLOCK_DEV_RAM)
|
||||
#include "nrf_block_dev_ram.h"
|
||||
#include <inttypes.h>
|
||||
|
||||
/**@file
|
||||
*
|
||||
* @ingroup nrf_block_dev
|
||||
* @{
|
||||
*
|
||||
* @brief This module implements block device API. It should be used as a reference block device.
|
||||
*/
|
||||
|
||||
#if NRF_BLOCK_DEV_RAM_CONFIG_LOG_ENABLED
|
||||
#define NRF_LOG_LEVEL NRF_BLOCK_DEV_RAM_CONFIG_LOG_LEVEL
|
||||
#define NRF_LOG_INFO_COLOR NRF_BLOCK_DEV_RAM_CONFIG_INFO_COLOR
|
||||
#define NRF_LOG_INST_DEBUG_COLOR NRF_BLOCK_DEV_RAM_CONFIG_DEBUG_COLOR
|
||||
#else
|
||||
#define NRF_LOG_LEVEL 0
|
||||
#endif
|
||||
#include "nrf_log.h"
|
||||
|
||||
static ret_code_t block_dev_ram_init(nrf_block_dev_t const * p_blk_dev,
|
||||
nrf_block_dev_ev_handler ev_handler,
|
||||
void const * p_context)
|
||||
{
|
||||
ASSERT(p_blk_dev);
|
||||
nrf_block_dev_ram_t const * p_ram_dev = CONTAINER_OF(p_blk_dev, nrf_block_dev_ram_t, block_dev);
|
||||
nrf_block_dev_ram_work_t * p_work = p_ram_dev->p_work;
|
||||
|
||||
NRF_LOG_INST_DEBUG(p_ram_dev->p_log, "Init");
|
||||
/* Calculate block device geometry.... */
|
||||
p_work->geometry.blk_size = p_ram_dev->ram_config.block_size;
|
||||
p_work->geometry.blk_count = p_ram_dev->ram_config.size /
|
||||
p_ram_dev->ram_config.block_size;
|
||||
p_work->p_context = p_context;
|
||||
p_work->ev_handler = ev_handler;
|
||||
|
||||
if (p_work->ev_handler)
|
||||
{
|
||||
/*Asynchronous operation (simulation)*/
|
||||
const nrf_block_dev_event_t ev = {
|
||||
NRF_BLOCK_DEV_EVT_INIT,
|
||||
NRF_BLOCK_DEV_RESULT_SUCCESS,
|
||||
NULL,
|
||||
p_work->p_context
|
||||
};
|
||||
|
||||
p_work->ev_handler(p_blk_dev, &ev);
|
||||
}
|
||||
|
||||
return NRF_SUCCESS;
|
||||
}
|
||||
|
||||
static ret_code_t block_dev_ram_uninit(nrf_block_dev_t const * p_blk_dev)
|
||||
{
|
||||
ASSERT(p_blk_dev);
|
||||
nrf_block_dev_ram_t const * p_ram_dev = CONTAINER_OF(p_blk_dev, nrf_block_dev_ram_t, block_dev);
|
||||
nrf_block_dev_ram_work_t * p_work = p_ram_dev->p_work;
|
||||
|
||||
NRF_LOG_INST_DEBUG(p_ram_dev->p_log, "Uninit");
|
||||
if (p_work->ev_handler)
|
||||
{
|
||||
/*Asynchronous operation (simulation)*/
|
||||
const nrf_block_dev_event_t ev = {
|
||||
NRF_BLOCK_DEV_EVT_UNINIT,
|
||||
NRF_BLOCK_DEV_RESULT_SUCCESS,
|
||||
NULL,
|
||||
p_work->p_context
|
||||
};
|
||||
|
||||
p_work->ev_handler(p_blk_dev, &ev);
|
||||
}
|
||||
|
||||
memset(p_work, 0, sizeof(nrf_block_dev_ram_work_t));
|
||||
return NRF_SUCCESS;
|
||||
}
|
||||
|
||||
static ret_code_t block_dev_ram_req(nrf_block_dev_t const * p_blk_dev,
|
||||
nrf_block_req_t const * p_blk,
|
||||
nrf_block_dev_event_type_t event)
|
||||
{
|
||||
ASSERT(p_blk_dev);
|
||||
ASSERT(p_blk);
|
||||
nrf_block_dev_ram_t const * p_ram_dev = CONTAINER_OF(p_blk_dev, nrf_block_dev_ram_t, block_dev);
|
||||
nrf_block_dev_ram_config_t const * p_ram_config = &p_ram_dev->ram_config;
|
||||
nrf_block_dev_ram_work_t const * p_work = p_ram_dev->p_work;
|
||||
|
||||
NRF_LOG_INST_DEBUG(p_ram_dev->p_log,
|
||||
((event == NRF_BLOCK_DEV_EVT_BLK_READ_DONE) ?
|
||||
"Read req from block %"PRIu32" size %"PRIu32"(x%"PRIu32") to %"PRIXPTR
|
||||
:
|
||||
"Write req to block %"PRIu32" size %"PRIu32"(x%"PRIu32") from %"PRIXPTR),
|
||||
p_blk->blk_id,
|
||||
p_blk->blk_count,
|
||||
p_blk_dev->p_ops->geometry(p_blk_dev)->blk_size,
|
||||
p_blk->p_buff);
|
||||
|
||||
if ((p_blk->blk_id + p_blk->blk_count) > p_work->geometry.blk_count)
|
||||
{
|
||||
NRF_LOG_INST_ERROR(p_ram_dev->p_log,
|
||||
((event == NRF_BLOCK_DEV_EVT_BLK_READ_DONE) ?
|
||||
"Out of range read req block %"PRIu32" count %"PRIu32" while max is %"PRIu32
|
||||
:
|
||||
"Out of range write req block %"PRIu32" count %"PRIu32", while max is %"PRIu32),
|
||||
p_blk->blk_id,
|
||||
p_blk->blk_count,
|
||||
p_blk_dev->p_ops->geometry(p_blk_dev)->blk_count);
|
||||
return NRF_ERROR_INVALID_ADDR;
|
||||
|
||||
}
|
||||
|
||||
/*Synchronous operation*/
|
||||
uint8_t * p_buff = p_ram_config->p_work_buffer;
|
||||
p_buff += p_blk->blk_id * p_work->geometry.blk_size;
|
||||
|
||||
const void * p_src = (event == NRF_BLOCK_DEV_EVT_BLK_READ_DONE) ? p_buff : p_blk->p_buff;
|
||||
void * p_dst = (event == NRF_BLOCK_DEV_EVT_BLK_READ_DONE) ? p_blk->p_buff : p_buff;
|
||||
|
||||
memcpy(p_dst, p_src, p_work->geometry.blk_size * p_blk->blk_count);
|
||||
|
||||
if (p_work->ev_handler)
|
||||
{
|
||||
/*Asynchronous operation (simulation)*/
|
||||
const nrf_block_dev_event_t ev = {
|
||||
event,
|
||||
NRF_BLOCK_DEV_RESULT_SUCCESS,
|
||||
p_blk,
|
||||
p_work->p_context
|
||||
};
|
||||
|
||||
p_work->ev_handler(p_blk_dev, &ev);
|
||||
}
|
||||
|
||||
return NRF_SUCCESS;
|
||||
}
|
||||
|
||||
static ret_code_t block_dev_ram_read_req(nrf_block_dev_t const * p_blk_dev,
|
||||
nrf_block_req_t const * p_blk)
|
||||
{
|
||||
return block_dev_ram_req(p_blk_dev, p_blk, NRF_BLOCK_DEV_EVT_BLK_READ_DONE);
|
||||
}
|
||||
|
||||
static ret_code_t block_dev_ram_write_req(nrf_block_dev_t const * p_blk_dev,
|
||||
nrf_block_req_t const * p_blk)
|
||||
{
|
||||
return block_dev_ram_req(p_blk_dev, p_blk, NRF_BLOCK_DEV_EVT_BLK_WRITE_DONE);
|
||||
}
|
||||
|
||||
static ret_code_t block_dev_ram_ioctl(nrf_block_dev_t const * p_blk_dev,
|
||||
nrf_block_dev_ioctl_req_t req,
|
||||
void * p_data)
|
||||
{
|
||||
nrf_block_dev_ram_t const * p_ram_dev = CONTAINER_OF(p_blk_dev, nrf_block_dev_ram_t, block_dev);
|
||||
switch (req)
|
||||
{
|
||||
case NRF_BLOCK_DEV_IOCTL_REQ_CACHE_FLUSH:
|
||||
{
|
||||
bool * p_flushing = p_data;
|
||||
NRF_LOG_INST_DEBUG(p_ram_dev->p_log, "IOCtl: Cache flush");
|
||||
if (p_flushing)
|
||||
{
|
||||
*p_flushing = false;
|
||||
}
|
||||
return NRF_SUCCESS;
|
||||
}
|
||||
case NRF_BLOCK_DEV_IOCTL_REQ_INFO_STRINGS:
|
||||
{
|
||||
if (p_data == NULL)
|
||||
{
|
||||
return NRF_ERROR_INVALID_PARAM;
|
||||
}
|
||||
|
||||
nrf_block_dev_info_strings_t const * * pp_strings = p_data;
|
||||
*pp_strings = &p_ram_dev->info_strings;
|
||||
return NRF_SUCCESS;
|
||||
}
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return NRF_ERROR_NOT_SUPPORTED;
|
||||
}
|
||||
|
||||
|
||||
static nrf_block_dev_geometry_t const * block_dev_ram_geometry(nrf_block_dev_t const * p_blk_dev)
|
||||
{
|
||||
ASSERT(p_blk_dev);
|
||||
nrf_block_dev_ram_t const * p_ram_dev = CONTAINER_OF(p_blk_dev, nrf_block_dev_ram_t, block_dev);
|
||||
nrf_block_dev_ram_work_t const * p_work = p_ram_dev->p_work;
|
||||
|
||||
return &p_work->geometry;
|
||||
}
|
||||
|
||||
const nrf_block_dev_ops_t nrf_block_device_ram_ops = {
|
||||
.init = block_dev_ram_init,
|
||||
.uninit = block_dev_ram_uninit,
|
||||
.read_req = block_dev_ram_read_req,
|
||||
.write_req = block_dev_ram_write_req,
|
||||
.ioctl = block_dev_ram_ioctl,
|
||||
.geometry = block_dev_ram_geometry,
|
||||
};
|
||||
|
||||
/** @} */
|
||||
#endif // NRF_MODULE_ENABLED(NRF_BLOCK_DEV_RAM)
|
||||
Reference in New Issue
Block a user