mirror of
https://gitlab.rtems.org/rtems/rtos/rtems.git
synced 2025-12-12 10:59:18 +08:00
313 lines
6.4 KiB
C
313 lines
6.4 KiB
C
/*
|
|
* RTEMS generic MPC5200 BSP
|
|
*
|
|
* This file contains functions to implement a slice timer.
|
|
*
|
|
* References: Clock driver for PPC403
|
|
*/
|
|
|
|
/*
|
|
* Author: Jay Monkman (jmonkman@frasca.com)
|
|
* Copyright (C) 1998 by Frasca International, Inc.
|
|
*
|
|
* Derived from c/src/lib/libcpu/ppc/ppc403/clock/clock.c:
|
|
* Author: Andrew Bray <andy@i-cubed.co.uk>
|
|
*
|
|
* Copyright (c) 1995 by i-cubed ltd.
|
|
*
|
|
* To anyone who acknowledges that this file is provided "AS IS"
|
|
* without any express or implied warranty:
|
|
* permission to use, copy, modify, and distribute this file
|
|
* for any purpose is hereby granted without fee, provided that
|
|
* the above copyright notice and this notice appears in all
|
|
* copies, and that the name of i-cubed limited not be used in
|
|
* advertising or publicity pertaining to distribution of the
|
|
* software without specific, written prior permission.
|
|
* i-cubed limited makes no representations about the suitability
|
|
* of this software for any purpose.
|
|
*
|
|
* Modifications for deriving timer clock from cpu system clock by
|
|
* Copyright (c) 1997 IMD Ingenieurbuero fuer Microcomputertechnik
|
|
*
|
|
* COPYRIGHT (c) 1989-1999.
|
|
* On-Line Applications Research Corporation (OAR).
|
|
*
|
|
* Copyright (c) 2003 IPR Engineering
|
|
*
|
|
* Copyright (c) 2005 embedded brains GmbH. All rights reserved.
|
|
*
|
|
* The license and distribution terms for this file may be
|
|
* found in the file LICENSE in this distribution or at
|
|
* http://www.rtems.org/license/LICENSE.
|
|
*
|
|
* Modifications for PPC405GP by Dennis Ehlin
|
|
*/
|
|
|
|
#include <bsp.h>
|
|
#include <rtems/bspIo.h>
|
|
#include <bsp/fatal.h>
|
|
#include <bsp/irq.h>
|
|
|
|
#include <rtems.h>
|
|
#include <rtems/clockdrv.h>
|
|
#include <rtems/libio.h>
|
|
|
|
#include <bsp/irq.h>
|
|
#include <bsp/mpc5200.h>
|
|
#include <bsp/slicetimer.h>
|
|
#include <stdio.h>
|
|
|
|
uint32_t value0 = 0;
|
|
uint32_t value1 = 0;
|
|
|
|
/*
|
|
* ISR Handlers
|
|
*/
|
|
void mpc5200_slt_isr(uint32_t slt_no)
|
|
{
|
|
uint32_t status;
|
|
struct mpc5200_slt *slt = (struct mpc5200_slt *)(&mpc5200.slt[slt_no]);
|
|
|
|
status = slt->tsr;
|
|
|
|
if(status & SLT_TSR_ST)
|
|
{
|
|
|
|
slt->tsr |= SLT_TSR_ST;
|
|
|
|
/*if(slt_no == SLT0)
|
|
slt0_user_defined_handler */
|
|
|
|
/*if(slt_no == SLT1)
|
|
slt1_user_defined_handler */
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
rtems_isr mpc5200_slt0_isr(rtems_irq_hdl_param unused)
|
|
{
|
|
|
|
mpc5200_slt_isr(SLT0);
|
|
|
|
}
|
|
|
|
|
|
rtems_isr mpc5200_slt1_isr(rtems_irq_hdl_param unused)
|
|
{
|
|
|
|
mpc5200_slt_isr(SLT1);
|
|
|
|
}
|
|
|
|
|
|
/*
|
|
* Initialize MPC5x00 slt
|
|
*/
|
|
void mpc5200_init_slt(uint32_t slt_no)
|
|
{
|
|
struct mpc5200_slt *slt = (struct mpc5200_slt *)(&mpc5200.slt[slt_no]);
|
|
|
|
slt->tsr = SLT_TSR_ST;
|
|
slt->cntrl = SLT_CNTRL_RW;
|
|
|
|
}
|
|
|
|
|
|
/*
|
|
* Set MPC5x00 slt counter
|
|
*/
|
|
void mpc5200_set_slt_count(uint32_t slt_no)
|
|
{
|
|
struct mpc5200_slt *slt = (struct mpc5200_slt *)(&mpc5200.slt[slt_no]);
|
|
|
|
if(slt_no == SLT0)
|
|
/* Calculate counter value 24 bit (must be greater than 255) => IPB_Clock=33MHz -> Int. every 7,75us - 508ms */
|
|
if((SLT_TSR_COUNT(SLT0_INT_FREQUENCY) > 0xFF) && (SLT_TSR_COUNT(SLT0_INT_FREQUENCY) < 0x1000000))
|
|
slt->tcr = SLT_TSR_COUNT(SLT0_INT_FREQUENCY);
|
|
|
|
if(slt_no == SLT1)
|
|
/* Calculate counter value 24 bit (must be greater than 255) => IPB_Clock=33MHz -> Int. every 7,75us - 508ms */
|
|
if((SLT_TSR_COUNT(SLT1_INT_FREQUENCY) > 0xFF) && (SLT_TSR_COUNT(SLT1_INT_FREQUENCY) < 0x1000000))
|
|
slt->tcr = SLT_TSR_COUNT(SLT1_INT_FREQUENCY);
|
|
|
|
}
|
|
|
|
|
|
/*
|
|
* Enable MPC5x00 slt interrupt
|
|
*/
|
|
void mpc5200_enable_slt_int(uint32_t slt_no)
|
|
{
|
|
struct mpc5200_slt *slt = (struct mpc5200_slt *)(&mpc5200.slt[slt_no]);
|
|
|
|
slt->cntrl |= SLT_CNTRL_TIMEN | SLT_CNTRL_INTEN;
|
|
|
|
}
|
|
|
|
|
|
/*
|
|
* Disable MPC5x00 slt interrupt
|
|
*/
|
|
void mpc5200_disable_slt_int(uint32_t slt_no)
|
|
{
|
|
struct mpc5200_slt *slt = (struct mpc5200_slt *)(&mpc5200.slt[slt_no]);
|
|
|
|
slt->cntrl &= ~(SLT_CNTRL_TIMEN | SLT_CNTRL_INTEN);
|
|
|
|
}
|
|
|
|
|
|
/*
|
|
* Check MPC5x00 slt status
|
|
*/
|
|
uint32_t mpc5200_check_slt_status(uint32_t slt_no)
|
|
{
|
|
struct mpc5200_slt *slt = (struct mpc5200_slt *)(&mpc5200.slt[slt_no]);
|
|
|
|
if(((slt->cntrl) & (SLT_CNTRL_TIMEN | SLT_CNTRL_INTEN)) == (SLT_CNTRL_TIMEN | SLT_CNTRL_INTEN))
|
|
return 1;
|
|
else
|
|
return 0;
|
|
|
|
}
|
|
|
|
/*
|
|
* switch MPC5x00 slt on
|
|
*/
|
|
static void sltOn(const rtems_irq_connect_data* irq)
|
|
{
|
|
uint32_t slt_no = 0;
|
|
|
|
if((irq->name) == BSP_SIU_IRQ_SL_TIMER0)
|
|
slt_no = 0;
|
|
|
|
if((irq->name) == BSP_SIU_IRQ_SL_TIMER1)
|
|
slt_no = 1;
|
|
|
|
mpc5200_set_slt_count((uint32_t)slt_no);
|
|
mpc5200_enable_slt_int((uint32_t)slt_no);
|
|
|
|
}
|
|
|
|
/*
|
|
* switch MPC5x00 slt off
|
|
*/
|
|
static void sltOff(const rtems_irq_connect_data* irq)
|
|
{
|
|
uint32_t slt_no = 0;
|
|
|
|
if((irq->name) == BSP_SIU_IRQ_SL_TIMER0)
|
|
slt_no = 0;
|
|
|
|
if((irq->name) == BSP_SIU_IRQ_SL_TIMER1)
|
|
slt_no = 1;
|
|
|
|
mpc5200_disable_slt_int((uint32_t)slt_no);
|
|
|
|
}
|
|
|
|
/*
|
|
* get status of MPC5x00 slt
|
|
*/
|
|
static int sltIsOn(const rtems_irq_connect_data* irq)
|
|
{
|
|
uint32_t slt_no = 0;
|
|
|
|
if((irq->name) == BSP_SIU_IRQ_SL_TIMER0)
|
|
slt_no = 0;
|
|
|
|
if((irq->name) == BSP_SIU_IRQ_SL_TIMER1)
|
|
slt_no = 1;
|
|
|
|
if(mpc5200_check_slt_status(slt_no))
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* MPC5x00 slt0 irq connect data
|
|
*/
|
|
static rtems_irq_connect_data slt0_IrqData =
|
|
{
|
|
BSP_SIU_IRQ_SL_TIMER0,
|
|
mpc5200_slt0_isr,
|
|
(rtems_irq_hdl_param) NULL,
|
|
(rtems_irq_enable)sltOn,
|
|
(rtems_irq_disable)sltOff,
|
|
(rtems_irq_is_enabled)sltIsOn
|
|
};
|
|
|
|
/*
|
|
* MPC5x00 slt1 irq connect data
|
|
*/
|
|
static rtems_irq_connect_data slt1_IrqData =
|
|
{
|
|
BSP_SIU_IRQ_SL_TIMER1,
|
|
mpc5200_slt1_isr,
|
|
(rtems_irq_hdl_param) NULL,
|
|
(rtems_irq_enable)sltOn,
|
|
(rtems_irq_disable)sltOff,
|
|
(rtems_irq_is_enabled)sltIsOn
|
|
};
|
|
|
|
/*
|
|
* call MPC5x00 slt install routines
|
|
*/
|
|
void Install_slt(rtems_device_minor_number slt_no)
|
|
{
|
|
|
|
mpc5200_init_slt((uint32_t)slt_no);
|
|
mpc5200_set_slt_count((uint32_t)slt_no);
|
|
|
|
}
|
|
|
|
/*
|
|
* MPC5x00 slt device driver initialize
|
|
*/
|
|
rtems_device_driver slt_initialize
|
|
(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void *pargp
|
|
)
|
|
{
|
|
|
|
/* force minor according to definitions in bsp.h */
|
|
if(USE_SLICETIMER_0)
|
|
{
|
|
|
|
Install_slt(0);
|
|
|
|
if(!BSP_install_rtems_irq_handler(&slt0_IrqData))
|
|
{
|
|
|
|
printk("Unable to connect PSC Irq handler\n");
|
|
bsp_fatal(MPC5200_FATAL_SLICETIMER_0_IRQ_INSTALL);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if(USE_SLICETIMER_1)
|
|
{
|
|
|
|
Install_slt(1);
|
|
|
|
if(!BSP_install_rtems_irq_handler(&slt1_IrqData))
|
|
{
|
|
|
|
printk("Unable to connect PSC Irq handler\n");
|
|
bsp_fatal(MPC5200_FATAL_SLICETIMER_1_IRQ_INSTALL);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return RTEMS_SUCCESSFUL;
|
|
|
|
}
|
|
|