Put initialization priorities as device driver Kconfig parameter. Initialization priority value for each platform is defined in the platform Kconfig file. Drivers and platform code use SYS_DEFINE_DEVICE to add and initialization function. Change-Id: I2f4f3c7370dac02408a1b50a0a1bade8b427a282 Signed-off-by: Dmitriy Korovkin <dmitriy.korovkin@windriver.com> Signed-off-by: Anas Nashif <anas.nashif@intel.com>
108 lines
3 KiB
C
108 lines
3 KiB
C
/* system.c - system/hardware module for the Quark SE BSP */
|
|
|
|
/*
|
|
* Copyright (c) 2015 Wind River Systems, Inc.
|
|
*
|
|
* 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
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
/*
|
|
DESCRIPTION
|
|
This module provides routines to initialize and support board-level
|
|
hardware for the Quark SE BSP.
|
|
*/
|
|
|
|
#include <nanokernel.h>
|
|
#include <misc/printk.h>
|
|
#include <misc/__assert.h>
|
|
#include "board.h"
|
|
#include <uart.h>
|
|
#include <drivers/ioapic.h>
|
|
#include <drivers/loapic.h>
|
|
#include <init.h>
|
|
#include <shared_mem.h>
|
|
|
|
#ifdef CONFIG_ARC_INIT
|
|
#define SCSS_REG_VAL(offset) \
|
|
(*((volatile uint32_t *)(SCSS_REGISTER_BASE+offset)))
|
|
|
|
#ifdef CONFIG_ARC_INIT_DEBUG
|
|
#define arc_init_debug printk
|
|
#else
|
|
#define arc_init_debug(x...) do { } while (0)
|
|
#endif
|
|
|
|
/**
|
|
*
|
|
* @brief ARC Init
|
|
*
|
|
* This routine initialize the ARC reset vector and
|
|
* starts the ARC processor.
|
|
* @return N/A
|
|
*/
|
|
static int arc_init(struct device *arg)
|
|
{
|
|
uint32_t *reset_vector;
|
|
|
|
ARG_UNUSED(arg);
|
|
|
|
if (!SCSS_REG_VAL(SCSS_SS_STS)) {
|
|
/* ARC shouldn't already be running! */
|
|
printk("ARC core already running!");
|
|
return DEV_FAIL;
|
|
}
|
|
|
|
/* Address of ARC side __reset stored in the first 4 bytes of arc.bin,
|
|
* we read the value and stick it in shared_mem->arc_start which is
|
|
* the beginning of the address space at 0xA8000000 */
|
|
reset_vector = (uint32_t *)RESET_VECTOR;
|
|
arc_init_debug("Reset vector address: %x\n", *reset_vector);
|
|
shared_data->arc_start = *reset_vector;
|
|
shared_data->flags = 0;
|
|
#ifndef CONFIG_ARC_INIT_DEBUG
|
|
/* Start the CPU */
|
|
SCSS_REG_VAL(SCSS_SS_CFG) |= ARC_RUN_REQ_A;
|
|
|
|
arc_init_debug("Waiting for arc to start...\n");
|
|
/* Block until the ARC core actually starts up */
|
|
while (SCSS_REG_VAL(SCSS_SS_STS) & 0x4000) {
|
|
}
|
|
|
|
/* Block until ARC's quark_se_init() sets a flag indicating it is ready,
|
|
* if we get stuck here ARC has run but has exploded very early */
|
|
arc_init_debug("Waiting for arc to init...\n");
|
|
while (!shared_data->flags & ARC_READY) {
|
|
}
|
|
#endif
|
|
|
|
return DEV_OK;
|
|
}
|
|
|
|
DECLARE_DEVICE_INIT_CONFIG(quark_se_ss_0, "", arc_init, NULL);
|
|
SYS_DEFINE_DEVICE(quark_se_ss_0, NULL, SECONDARY,
|
|
CONFIG_KERNEL_INIT_PRIORITY_DEFAULT);
|
|
|
|
#endif /*CONFIG_ARC_INIT*/
|
|
|
|
#ifdef CONFIG_IOAPIC
|
|
DECLARE_DEVICE_INIT_CONFIG(ioapic_0, "", _ioapic_init, NULL);
|
|
SYS_DEFINE_DEVICE(ioapic_0, NULL, PRIMARY, CONFIG_KERNEL_INIT_PRIORITY_DEFAULT);
|
|
|
|
#endif /* CONFIG_IOAPIC */
|
|
|
|
#ifdef CONFIG_LOAPIC
|
|
DECLARE_DEVICE_INIT_CONFIG(loapic_0, "", _loapic_init, NULL);
|
|
SYS_DEFINE_DEVICE(loapic_0, NULL, PRIMARY, CONFIG_KERNEL_INIT_PRIORITY_DEFAULT);
|
|
|
|
#endif /* CONFIG_LOAPIC */
|
|
|