helpers.c

/******************************************************************************
 * Copyright (c) 2020 Hesham Almatary
 * See LICENSE_CHERI for license details.
 *****************************************************************************/

/******************************************************************************
 * Copyright (c) 2007, 2012, 2013 IBM Corporation
 * All rights reserved.
 * This program and the accompanying materials
 * are made available under the terms of the BSD License
 * which accompanies this distribution, and is available at
 * http://www.opensource.org/licenses/bsd-license.php
 *
 * Contributors:
 *     IBM Corporation - initial implementation
 *****************************************************************************/
/*
 * All functions concerning interface to slof
 */

#include <stdio.h>
#include "helpers.h"

#include <FreeRTOS.h>
#include "task.h"

#define pdUS_TO_TICKS( xTimeInUs ) ( ( TickType_t ) ( ( ( TickType_t ) ( xTimeInUs ) * ( TickType_t ) configTICK_RATE_HZ ) / ( TickType_t ) 1000000 ) )

void *SLOF_alloc_mem(size_t size)
{
	return pvPortMalloc(size);
}

void* SLOF_alloc_mem_aligned(size_t size, size_t alignment) {
  void* address = NULL;
  size_t new_size = (size + alignment + sizeof(void*));

  if (alignment < portBYTE_ALIGNMENT)
    alignment = portBYTE_ALIGNMENT;

  address = pvPortMalloc(new_size);

  void **ptr = (void**)((uintptr_t)(address + alignment + sizeof(void*)) & ~(alignment - 1));
  ptr[-1] = address;
  return ptr;
}

void SLOF_free_mem(void *addr, long size)
{
	vPortFree(addr);
}

void SLOF_free_mem_aligned(void *addr)
{
    vPortFree(((void**) addr)[-1]);
}

long SLOF_dma_map_in(void *virt, long size, int cacheable)
{
	// FIXME Empty as only used if IOMMU and VIRTIO_VERSION1 are supported
	(void) size;
	(void) cacheable;
	return (long) virt;
}

void SLOF_dma_map_out(long phys, void *virt, long size)
{
	// FIXME Empty as only used if IOMMU and VIRTIO_VERSION1 are supported
	(void) size;
	(void) phys;
	(void) virt;
}

/**
 * get msec-timer value
 * access to HW register
 * overrun will occur if boot exceeds 1.193 hours (49 days)
 *
 * @param   -
 * @return  actual timer value in ms as 32bit
 */
uint32_t SLOF_GetTimer(void)
{
    uint64_t us = portGET_RUN_TIME_COUNTER_VALUE();
    return (uint32_t) (us / 1000);
}

void SLOF_msleep(uint32_t time)
{
  vTaskDelay( pdMS_TO_TICKS ( time ) );
}

void SLOF_usleep(uint32_t time)
{
  vTaskDelay( pdUS_TO_TICKS ( time ) );
}