system_netx.c

Go to the documentation of this file.

/**************************************************************************/
/*
 * Copyright (c) 2009-2016 ARM Limited. All rights reserved.
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Licensed 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
 *
 * 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.
 */

#include <stdint.h>
#include <string.h>
#include "cmsis_gcc.h"
#include "system_netx.h"
#include "netx90_app.h"

#define SYSTEM_CLOCK    (100000000UL)

uint32_t SystemCoreClock = SYSTEM_CLOCK; /* System Clock Frequency (Core Clock)*/

/*---------------------------------------------------------------------------
 Clock functions
 *----------------------------------------------------------------------------*/

void SystemCoreClockUpdate(void) /* Get Core Clock Frequency      */
{
  SystemCoreClock = SYSTEM_CLOCK;
}

void SystemInitFault(void)
{
  while(1)
    ;
}

#ifdef NVIC_SOFT_VECTOR

void * g_avpfVTOR[__VectorsSize] __attribute__(( aligned(128)))   ;
#endif

NETX_TEMP_CALIBRATION_T g_atTemperatureCalibrationData[2];

#ifndef SYSTEM_TEMPERATURE_FLOATING_POINT_SUPPORT

int g_TemperatureGradient = (int) 0xfffa6048ul;

int g_TemperatureIntercept = 2455;

void SystemTemperatureByADCValue(uint32_t ulADCValue, int* TempValue)
{
  *TempValue = (((int) ulADCValue) - g_TemperatureIntercept) * 0xFFFF / g_TemperatureGradient;
}
#else /* SYSTEM_TEMPERATURE_FLOATING_POINT_SUPPORT */

float g_TemperatureGradient = -5.624;

float g_TemperatureIntercept = 2455;

void SystemTemperatureByADCValue(uint32_t ulADCValue, float* TempValue)
{
  *TempValue = (((float)ulADCValue) - g_TemperatureIntercept) / g_TemperatureGradient;
}
#endif /* SYSTEM_TEMPERATURE_FLOATING_POINT_SUPPORT */

//extern DRV_TRAMPOLINE_T tPageReaderFunction;
//extern DRV_TRAMPOLINE_T tPageFlasherFunction;
volatile uint32_t ulRead = 0;

void PageReader(void)
{
  volatile NETX_TEMP_CALIBRATION_T * const ptCalibrationDataPosition = (void * const ) 0x00000800;
  __disable_irq();
  iflash_cfg2->iflash_reset = 1u; // reset flash for cache reset
  ulRead = iflash_cfg2->iflash_reset;
  iflash_cfg2->iflash_reset = 0u; // enable it again with an empty cache
  ulRead = iflash_cfg2->iflash_reset;
  iflash_cfg2->iflash_ifren_cfg = 1u; // show info page
  ulRead = iflash_cfg2->iflash_ifren_cfg;
  __DSB();
  g_atTemperatureCalibrationData[0] = ptCalibrationDataPosition[0];
  g_atTemperatureCalibrationData[1] = ptCalibrationDataPosition[1];
  __DSB();
  iflash_cfg2->iflash_ifren_cfg = 0u; // hide info page
  ulRead = iflash_cfg2->iflash_ifren_cfg;
  iflash_cfg2->iflash_reset = 1u; // reset flash for cache reset
  ulRead = iflash_cfg2->iflash_reset;
  iflash_cfg2->iflash_reset = 0u; // enable it again with an empty cache
  ulRead = iflash_cfg2->iflash_reset;
  __DSB();
  __ISB();
  __enable_irq();
}

void* g_avpfHVTOR[16] __attribute__(( aligned(128))) = { 0, 0, SystemInitFault, SystemInitFault, SystemInitFault, SystemInitFault, SystemInitFault,
  SystemInitFault, SystemInitFault, SystemInitFault, SystemInitFault, SystemInitFault, SystemInitFault, SystemInitFault, SystemInitFault,
  SystemInitFault };

void callPageReader()
{
  uintptr_t ulOriginalVTOR;
  if(tPageReaderFunction.entry != 0)
  {
    ulOriginalVTOR = SCB->VTOR;
    SCB->VTOR = (uintptr_t) g_avpfHVTOR;
    memcpy(tPageReaderFunction.target, tPageReaderFunction.source, tPageReaderFunction.length);
    __DSB();
    __ISB();
    tPageReaderFunction.entry();
    ulRead = ulRead;
    SCB->VTOR = ulOriginalVTOR;
  }
}

typedef enum DRV_FLASHER_JOB_Etag
{
  DRV_FLASHER_JOB_ERASE, 
  DRV_FLASHER_JOB_COPY, 
  DRV_FLASHER_JOB_ERASE_COPY, 
} DRV_FLASHER_JOB_E;

#define intflash2 ((uint32_t*)0x00200000)

void PageFlasher(DRV_FLASHER_JOB_E eJob, void * pvDestination, void * pvSource, size_t size)
{
  __disable_irq();
  iflash_cfg2->iflash_reset = 1u; // reset flash
  ulRead = iflash_cfg2->iflash_reset;
  iflash_cfg2->iflash_reset = 0u; // enable it again with an empty cache
  ulRead = iflash_cfg2->iflash_reset;
  __DSB();
  // Keep in mind, that there are redundancy pages.
  // Keep in mind, that the xpic/other masters might read from flash.
  // Keep in mind, that the flash is located in a different data switch as the
  // iflash control logic.
  // Erase Page
  // Copy Page
  iflash_cfg2->iflash_reset = 1u; // reset flash for cache reset
  ulRead = iflash_cfg2->iflash_reset;
  iflash_cfg2->iflash_reset = 0u; // enable it again with an empty cache
  ulRead = iflash_cfg2->iflash_reset;
  __DSB();
  __ISB();
  __enable_irq();
}

void (* const pPageReader)(void) = PageReader;

void (* const pPageFlasher)(DRV_FLASHER_JOB_E, void *, void *, size_t) = PageFlasher;

static void callConstructors(void)
{

  /*lint -save -e681 */
  // Call each function in the list.
  for(void (**p)() = &__preinit_array_start; p < &__preinit_array_end; ++p)
  {
    (*p)();
  }
  // Call each function in the list.
  for(void (**p)() = &__init_array_start; p < &__init_array_end; ++p)
  {
    (*p)();
  }
  /*lint -restore */
}

void SystemInit(void)
{
#ifdef NVIC_SOFT_VECTOR
  memcpy(g_avpfVTOR, __Vectors, sizeof(g_avpfVTOR));
  SCB->VTOR = (uintptr_t) g_avpfVTOR;
#endif
  SystemCoreClockUpdate();
  callConstructors();
}