rt-thread/bsp/raspberry-pi/raspi3-32/driver/drv_timer.c

/*
 * Copyright (c) 2006-2021, RT-Thread Development Team
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Change Logs:
 * Date           Author         Notes
 * 2019-07-29     zdzn           first version
 */

#include "drv_timer.h"

#ifdef BSP_USING_SYSTIMER

static void raspi_systimer_init(rt_clock_timer_t *clock_timer, rt_uint32_t state)
{
    if (state == 0)
        clock_timer->ops->stop(clock_timer);
}

static rt_err_t raspi_systimer_start(rt_clock_timer_t *clock_timer, rt_uint32_t cnt, rt_clock_timer_mode_t mode)
{
    rt_err_t result = RT_EOK;
    rt_systimer_t *timer = (rt_systimer_t *)clock_timer->parent.user_data;
    int timer_id = timer->timer_id;

    if (mode == CLOCK_TIMER_MODE_PERIOD)
        timer->cnt = cnt;
    else
        timer->cnt = 0;

    __sync_synchronize();
    if (timer_id == 1)
    {
        rt_hw_interrupt_umask(IRQ_SYSTEM_TIMER_1);
        STIMER_C1 = STIMER_CLO + cnt;
    }
    else if (timer_id == 3)
    {
        rt_hw_interrupt_umask(IRQ_SYSTEM_TIMER_3);
        STIMER_C3 = STIMER_CLO + cnt;
    }
    else
        result = -RT_ERROR;

    __sync_synchronize();

    return result;
}

static void raspi_systimer_stop(rt_clock_timer_t *clock_timer)
{
    rt_systimer_t *timer = (rt_systimer_t *)clock_timer->parent.user_data;
    int timer_id = timer->timer_id;
    if (timer_id == 1)
        rt_hw_interrupt_mask(IRQ_SYSTEM_TIMER_1);
    else if (timer_id == 3)
        rt_hw_interrupt_mask(IRQ_SYSTEM_TIMER_3);

}

static rt_err_t raspi_systimer_ctrl(rt_clock_timer_t *timer, rt_uint32_t cmd, void *arg)
{
    /* The frequency value is an immutable value. */
    if (cmd == CLOCK_TIMER_CTRL_FREQ_SET)
    {
        return RT_EOK;
    }
    else
    {
        return -RT_ENOSYS;
    }
}


void rt_device_systimer_isr(int vector, void *param)
{

    rt_clock_timer_t *clock_timer = (rt_clock_timer_t *) param;
    rt_systimer_t *timer = (rt_systimer_t *)clock_timer->parent.user_data;
    RT_ASSERT(timer != RT_NULL);

    int timer_id = timer->timer_id;

    __sync_synchronize();
    if (timer_id == 1)
    {
        STIMER_CS = 0x2;
        STIMER_C1 = STIMER_CLO + timer->cnt;
    }
    else if (timer_id == 3)
    {
        STIMER_CS = 0x8;
        STIMER_C3 = STIMER_CLO + timer->cnt;
    }
    __sync_synchronize();

    rt_clock_timer_isr(clock_timer);
}

static struct rt_clock_timer_device _clock_timer1;
static struct rt_clock_timer_device _clock_timer3;

static rt_systimer_t _systimer1;
static rt_systimer_t _systimer3;

const static struct rt_clock_timer_ops systimer_ops =
{
    raspi_systimer_init,
    raspi_systimer_start,
    raspi_systimer_stop,
    RT_NULL,
    raspi_systimer_ctrl
};

static const struct rt_clock_timer_info _info =
{
    1000000,            /* the maxinum count frequency can be set */
    1000000,            /* the maxinum count frequency can be set */
    0xFFFFFFFF,         /* the maximum counter value */
    CLOCK_TIMER_CNTMODE_UP  /* count mode (inc/dec) */
};

#endif

int rt_hw_systimer_init(void)
{

#ifdef BSP_USING_SYSTIMER

#ifdef RT_USING_SYSTIMER1
    _systimer1.timer_id =1;
    _clock_timer1.ops = &systimer_ops;
    _clock_timer1.info = &_info;
    rt_clock_timer_register(&_clock_timer1, "timer1",&_systimer1);
    rt_hw_interrupt_install(IRQ_SYSTEM_TIMER_1, rt_device_systimer_isr, &_clock_timer1, "systimer1");
    rt_hw_interrupt_umask(IRQ_SYSTEM_TIMER_1);
#endif

#ifdef RT_USING_SYSTIMER3
    _systimer3.timer_id =3;
    _clock_timer3.ops = &systimer_ops;
    _clock_timer3.info = &_info;
    rt_clock_timer_register(&_clock_timer3, "timer3",&_systimer3);
    rt_hw_interrupt_install(IRQ_SYSTEM_TIMER_3, rt_device_systimer_isr, &_clock_timer3, "systimer3");
    rt_hw_interrupt_umask(IRQ_SYSTEM_TIMER_3);
#endif

#endif

    return 0;
}

INIT_DEVICE_EXPORT(rt_hw_systimer_init);