92 lines
2.1 KiB
C
92 lines
2.1 KiB
C
/*
|
|
* Copyright (c) 2021 Microchip Inc.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT microchip_xec_bbram
|
|
|
|
#include <zephyr/drivers/bbram.h>
|
|
#include <errno.h>
|
|
#include <soc.h>
|
|
#include <zephyr/sys/util.h>
|
|
|
|
#include <zephyr/logging/log.h>
|
|
LOG_MODULE_REGISTER(bbram, CONFIG_BBRAM_LOG_LEVEL);
|
|
|
|
/** Device config */
|
|
struct bbram_xec_config {
|
|
/** BBRAM base address */
|
|
uint8_t *base;
|
|
/** BBRAM size (Unit:bytes) */
|
|
int size;
|
|
};
|
|
|
|
static int bbram_xec_check_invalid(const struct device *dev)
|
|
{
|
|
struct vbatr_regs *const regs = (struct vbatr_regs *)(DT_REG_ADDR_BY_NAME(
|
|
DT_NODELABEL(pcr), vbatr));
|
|
|
|
if (regs->PFRS & BIT(MCHP_VBATR_PFRS_VBAT_RST_POS)) {
|
|
regs->PFRS |= BIT(MCHP_VBATR_PFRS_VBAT_RST_POS);
|
|
LOG_ERR("VBAT power rail failure");
|
|
return -EFAULT;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bbram_xec_get_size(const struct device *dev, size_t *size)
|
|
{
|
|
const struct bbram_xec_config *dcfg = dev->config;
|
|
|
|
*size = dcfg->size;
|
|
return 0;
|
|
}
|
|
|
|
static int bbram_xec_read(const struct device *dev, size_t offset, size_t size,
|
|
uint8_t *data)
|
|
{
|
|
const struct bbram_xec_config *dcfg = dev->config;
|
|
|
|
if (size < 1 || offset + size > dcfg->size) {
|
|
LOG_ERR("Invalid params");
|
|
return -EFAULT;
|
|
}
|
|
|
|
bytecpy(data, dcfg->base + offset, size);
|
|
return 0;
|
|
}
|
|
|
|
static int bbram_xec_write(const struct device *dev, size_t offset, size_t size,
|
|
const uint8_t *data)
|
|
{
|
|
const struct bbram_xec_config *dcfg = dev->config;
|
|
|
|
if (size < 1 || offset + size > dcfg->size) {
|
|
LOG_ERR("Invalid params");
|
|
return -EFAULT;
|
|
}
|
|
|
|
bytecpy(dcfg->base + offset, data, size);
|
|
return 0;
|
|
}
|
|
|
|
static const struct bbram_driver_api bbram_xec_driver_api = {
|
|
.check_invalid = bbram_xec_check_invalid,
|
|
.get_size = bbram_xec_get_size,
|
|
.read = bbram_xec_read,
|
|
.write = bbram_xec_write,
|
|
};
|
|
|
|
#define BBRAM_INIT(inst) \
|
|
static const struct bbram_xec_config bbram_cfg_##inst = { \
|
|
.base = (uint8_t *)(DT_INST_REG_ADDR(inst)), \
|
|
.size = DT_INST_REG_SIZE(inst), \
|
|
}; \
|
|
DEVICE_DT_INST_DEFINE(inst, NULL, NULL, NULL, &bbram_cfg_##inst,\
|
|
PRE_KERNEL_1, CONFIG_BBRAM_INIT_PRIORITY, \
|
|
&bbram_xec_driver_api);
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(BBRAM_INIT);
|