| /* | |
| * Copyright (c) 2020, The OpenThread Authors. | |
| * 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 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 holder nor the | |
| * names of its contributors may be used to endorse or promote products | |
| * derived from this software without specific prior written permission. | |
| * | |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS 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 THE COPYRIGHT HOLDER 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 "platform-simulation.h" | |
| #include <assert.h> | |
| #include <fcntl.h> | |
| #include <stdio.h> | |
| #include <stdlib.h> | |
| #include <string.h> | |
| #include <sys/stat.h> | |
| #include <unistd.h> | |
| #include <openthread/config.h> | |
| #include <openthread/logging.h> | |
| #include <openthread/platform/flash.h> | |
| #include "lib/platform/exit_code.h" | |
| static int sFlashFd = -1; | |
| enum | |
| { | |
| SWAP_SIZE = 2048, | |
| SWAP_NUM = 2, | |
| }; | |
| void otPlatFlashInit(otInstance *aInstance) | |
| { | |
| const char *path = OPENTHREAD_CONFIG_POSIX_SETTINGS_PATH; | |
| char fileName[sizeof(OPENTHREAD_CONFIG_POSIX_SETTINGS_PATH) + 32]; | |
| struct stat st; | |
| bool create = false; | |
| const char *offset = getenv("PORT_OFFSET"); | |
| memset(&st, 0, sizeof(st)); | |
| if (stat(path, &st) == -1) | |
| { | |
| mkdir(path, 0777); | |
| } | |
| if (offset == NULL) | |
| { | |
| offset = "0"; | |
| } | |
| snprintf(fileName, sizeof(fileName), "%s/%s_%d.flash", path, offset, gNodeId); | |
| if (access(fileName, 0)) | |
| { | |
| create = true; | |
| } | |
| sFlashFd = open(fileName, O_RDWR | O_CREAT | O_CLOEXEC, 0600); | |
| VerifyOrDie(sFlashFd >= 0, OT_EXIT_ERROR_ERRNO); | |
| lseek(sFlashFd, 0, SEEK_SET); | |
| if (create) | |
| { | |
| for (uint8_t index = 0; index < (uint8_t)SWAP_NUM; index++) | |
| { | |
| otPlatFlashErase(aInstance, index); | |
| } | |
| } | |
| } | |
| uint32_t otPlatFlashGetSwapSize(otInstance *aInstance) | |
| { | |
| OT_UNUSED_VARIABLE(aInstance); | |
| return SWAP_SIZE; | |
| } | |
| void otPlatFlashErase(otInstance *aInstance, uint8_t aSwapIndex) | |
| { | |
| OT_UNUSED_VARIABLE(aInstance); | |
| uint8_t buffer[SWAP_SIZE]; | |
| uint32_t address; | |
| ssize_t rval; | |
| assert((sFlashFd >= 0) && (aSwapIndex < SWAP_NUM)); | |
| address = aSwapIndex ? SWAP_SIZE : 0; | |
| memset(buffer, 0xff, sizeof(buffer)); | |
| rval = pwrite(sFlashFd, buffer, sizeof(buffer), (off_t)address); | |
| VerifyOrDie(rval == SWAP_SIZE, OT_EXIT_ERROR_ERRNO); | |
| } | |
| void otPlatFlashRead(otInstance *aInstance, uint8_t aSwapIndex, uint32_t aOffset, void *aData, uint32_t aSize) | |
| { | |
| OT_UNUSED_VARIABLE(aInstance); | |
| uint32_t address; | |
| ssize_t rval; | |
| assert((sFlashFd >= 0) && (aSwapIndex < SWAP_NUM) && (aSize <= SWAP_SIZE) && (aOffset <= (SWAP_SIZE - aSize))); | |
| address = aSwapIndex ? SWAP_SIZE : 0; | |
| rval = pread(sFlashFd, aData, aSize, (off_t)(address + aOffset)); | |
| VerifyOrDie((uint32_t)rval == aSize, OT_EXIT_ERROR_ERRNO); | |
| } | |
| void otPlatFlashWrite(otInstance *aInstance, uint8_t aSwapIndex, uint32_t aOffset, const void *aData, uint32_t aSize) | |
| { | |
| OT_UNUSED_VARIABLE(aInstance); | |
| uint32_t address; | |
| uint8_t byte; | |
| ssize_t rval; | |
| assert((sFlashFd >= 0) && (aSwapIndex < SWAP_NUM) && (aSize <= SWAP_SIZE) && (aOffset <= (SWAP_SIZE - aSize))); | |
| address = aSwapIndex ? SWAP_SIZE : 0; | |
| address += aOffset; | |
| for (uint32_t offset = 0; offset < aSize; offset++) | |
| { | |
| rval = pread(sFlashFd, &byte, sizeof(byte), (off_t)(address + offset)); | |
| VerifyOrDie(rval == sizeof(byte), OT_EXIT_ERROR_ERRNO); | |
| // Use bitwise AND to emulate the behavior of flash memory | |
| byte &= ((uint8_t *)aData)[offset]; | |
| rval = pwrite(sFlashFd, &byte, sizeof(byte), (off_t)(address + offset)); | |
| VerifyOrDie(rval == sizeof(byte), OT_EXIT_ERROR_ERRNO); | |
| } | |
| } |