/****************************************************************************
* apps/examples/esp32_himem/esp32_himem_main.c
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance with the
* License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
* License for the specific language governing permissions and limitations
* under the License.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/config.h>
#include <stdio.h>
#include <fcntl.h>
#include <stdbool.h>
#include <stdint.h>
#include <assert.h>
#include <unistd.h>
#include <nuttx/himem/himem.h>
/* Fills the memory in 32-bit words for speed. */
static void fill_mem(void *mem, int len)
{
uint32_t *p = (uint32_t *)mem;
unsigned int val = 0xa5a5a5a5;
for (int i = 0; i < len / 4; i++)
{
*p++ = val;
}
}
/* Check the memory filled by fill_mem. Returns true if the data matches
* the data that fill_mem wrote.
* Returns true if there's a match, false when the region differs from what
* should be there.
*/
static bool check_mem(void *mem, int len, int phys_addr)
{
uint32_t *p = (uint32_t *)mem;
unsigned int val = 0xa5a5a5a5;
for (int i = 0; i < len / 4; i++)
{
if (val != *p)
{
printf("check_mem: %x has 0x%08x expected 0x%08x\n",
phys_addr + ((char *)p - (char *)mem), *p, val);
return false;
}
p++;
}
return true;
}
/* Allocate a himem region, fill it with data, check it and release it. */
static int test_region(int fd, struct esp_himem_par *param)
{
int ret;
int i;
DEBUGASSERT(param != NULL);
/* Set predefined parameters */
param->len = ESP_HIMEM_BLKSZ;
param->range_offset = 0;
param->flags = 0;
/* Allocate the memory we're going to check. */
ret = ioctl(fd, HIMEMIOC_ALLOC_BLOCKS, (unsigned long)((uintptr_t)param));
if (ret < 0)
{
fprintf(stderr, "ERROR: ioctl(ALLOC_BLOCKS) failed: %d\n", errno);
return -ENOMEM;
}
/* Allocate a block of address range */
ret = ioctl(fd, HIMEMIOC_ALLOC_MAP_RANGE,
(unsigned long)((uintptr_t)param));
if (ret < 0)
{
fprintf(stderr, "ERROR: ioctl(ALLOC_MAP_RANGE) failed: %d\n", errno);
return -ENOMEM;
}
for (i = 0; i < param->memfree; i += ESP_HIMEM_BLKSZ)
{
param->ptr = NULL;
param->ram_offset = i;
/* Map in block, write pseudo-random data, unmap block. */
ret = ioctl(fd, HIMEMIOC_MAP, (unsigned long)((uintptr_t)param));
if (ret < 0)
{
fprintf(stderr, "ERROR: ioctl(MAP) failed: %d\n", errno);
ret = -ENOMEM;
goto free_rammem;
}
fill_mem(param->ptr, ESP_HIMEM_BLKSZ);
ret = ioctl(fd, HIMEMIOC_UNMAP, (unsigned long)((uintptr_t)param));
if (ret < 0)
{
fprintf(stderr, "ERROR: ioctl(UNMAP) failed: %d\n", errno);
ret = -ENOMEM;
goto free_rammem;
}
}
/* give the OS some time to do things so the task watchdog doesn't bark */
usleep(1);
for (i = 0; i < param->memfree; i += ESP_HIMEM_BLKSZ)
{
param->ptr = NULL;
param->ram_offset = i;
/* Map in block, check against earlier written pseudo-random data,
* unmap block.
*/
ret = ioctl(fd, HIMEMIOC_MAP, (unsigned long)((uintptr_t)param));
if (ret < 0)
{
fprintf(stderr, "ERROR: ioctl(MAP) failed: %d\n", errno);
ret = -ENOMEM;
goto free_rammem;
}
if (!check_mem(param->ptr, ESP_HIMEM_BLKSZ, i))
{
printf("Error in block %d\n", i / ESP_HIMEM_BLKSZ);
ret = -ENOMEM;
goto free_rammem;
}
ret = ioctl(fd, HIMEMIOC_UNMAP, (unsigned long)((uintptr_t)param));
if (ret < 0)
{
fprintf(stderr, "ERROR: ioctl(UNMAP) failed: %d\n", errno);
ret = -ENOMEM;
goto free_rammem;
}
}
/* Free allocated memory */
free_rammem:
ret = ioctl(fd, HIMEMIOC_FREE_MAP_RANGE,
(unsigned long)((uintptr_t)param));
if (ret < 0)
{
fprintf(stderr, "ERROR: ioctl(FREE_MAP_RANGE) failed: %d\n", errno);
}
free_memaddr:
ret = ioctl(fd, HIMEMIOC_FREE_BLOCKS, (unsigned long)((uintptr_t)param));
if (ret < 0)
{
fprintf(stderr, "ERROR: ioctl(FREE_BLOCKS) failed: %d\n", errno);
}
return ret;
}
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* esp32_himem_main
****************************************************************************/
int main(int argc, FAR char *argv[])
{
struct esp_himem_par param;
int ret;
int fd;
fd = open("/dev/himem", O_RDONLY);
if (fd < 0)
{
printf("Failed to open /dev/himem, error = %d!\n", errno);
return -ENODEV;
}
ret = ioctl(fd, HIMEMIOC_GET_PHYS_SIZE, ¶m);
if (ret < 0)
{
printf("Failed to run ioctl HIMEMIOC_GET_PHYS_SIZE, error = %d!\n",
errno);
close(fd);
return -ENOMEM;
}
ret = ioctl(fd, HIMEMIOC_GET_FREE_SIZE, ¶m);
if (ret < 0)
{
printf("Failed to run ioctl HIMEMIOC_GET_FREE_SIZE, error = %d!\n",
errno);
close(fd);
return -ENOMEM;
}
printf("Himem has %dKiB of memory, %dKiB of which is free.\
\nTesting the free memory...\n", (int) param.memcnt / 1024,
(int) param.memfree / 1024);
test_region(fd, ¶m);
printf("Done!\n");
}