WebSVN – HelenOS – Diff – /trunk/kernel/arch/ia64/src/drivers/it.c


/*
 * Copyright (c) 2005 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/** @addtogroup ia64   
 * @{
 */
/** @file
 */
 
/** Interval Timer driver. */
 
#include <arch/drivers/it.h>
#include <arch/interrupt.h>
#include <arch/register.h>
#include <arch/asm.h>
#include <arch/barrier.h>
#include <time/clock.h>
#include <ddi/irq.h>
#include <ddi/device.h>
#include <arch.h>
 
#define IT_SERVICE_CLOCKS 64
 
static irq_t it_irq;
 
static irq_ownership_t it_claim(void);
static void it_interrupt(irq_t *irq, void *arg, ...);
 
/** Initialize Interval Timer. */
void it_init(void)
{
    cr_itv_t itv;
   
    if(config.cpu_active==1)
    {
        irq_initialize(&it_irq);
        it_irq.inr = INTERRUPT_TIMER;
        it_irq.devno = device_assign_devno();
        it_irq.claim = it_claim;
        it_irq.handler = it_interrupt;
        irq_register(&it_irq);
    }
   
    /* initialize Interval Timer external interrupt vector */
    itv.value = itv_read();
    itv.vector = INTERRUPT_TIMER;
    itv.m = 0;
    itv_write(itv.value);
 
    /* set Interval Timer Counter to zero */
    itc_write(0);
   
    /* generate first Interval Timer interrupt in IT_DELTA ticks */
    itm_write(IT_DELTA);
 
    /* propagate changes */
    srlz_d();
}
 
/** Always claim ownership for this IRQ.
 *
 * Other devices are responsible to avoid using INR 0.
 *
 * @return Always IRQ_ACCEPT.
 */
irq_ownership_t it_claim(void)
{
    return IRQ_ACCEPT;
}
 
/** Process Interval Timer interrupt. */
void it_interrupt(irq_t *irq, void *arg, ...)
{
    int64_t c;
    int64_t m;
   
    eoi_write(EOI);
   
    m = itm_read();
   
    while (1) {
        c = itc_read();
        c += IT_SERVICE_CLOCKS;
 
        m += IT_DELTA;
        if (m - c < 0)
            CPU->missed_clock_ticks++;
        else
            break;
    }
   
    itm_write(m);
    srlz_d();               /* propagate changes */
 
    /*
     * We are holding a lock which prevents preemption.
     * Release the lock, call clock() and reacquire the lock again.
     */
    spinlock_unlock(&irq->lock);   
    clock();
    spinlock_lock(&irq->lock);
}
 
/** @}
 */
 

Rev 2107	Rev 3578
1	/*	1	/*
2	* Copyright (c) 2005 Jakub Jermar	2	* Copyright (c) 2005 Jakub Jermar
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup ia64	29	/** @addtogroup ia64
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	*/	33	*/
34		34
35	/** Interval Timer driver. */	35	/** Interval Timer driver. */
36		36
37	#include <arch/drivers/it.h>	37	#include <arch/drivers/it.h>
38	#include <arch/interrupt.h>	38	#include <arch/interrupt.h>
39	#include <arch/register.h>	39	#include <arch/register.h>
40	#include <arch/asm.h>	40	#include <arch/asm.h>
41	#include <arch/barrier.h>	41	#include <arch/barrier.h>
42	#include <time/clock.h>	42	#include <time/clock.h>
43	#include <ddi/irq.h>	43	#include <ddi/irq.h>
44	#include <ddi/device.h>	44	#include <ddi/device.h>
45	#include <arch.h>	45	#include <arch.h>
46		46
47	#define IT_SERVICE_CLOCKS 64	47	#define IT_SERVICE_CLOCKS 64
48		48
49	static irq_t it_irq;	49	static irq_t it_irq;
50		50
51	static irq_ownership_t it_claim(void);	51	static irq_ownership_t it_claim(void);
52	static void it_interrupt(irq_t irq, void arg, ...);	52	static void it_interrupt(irq_t irq, void arg, ...);
53		53
54	/** Initialize Interval Timer. */	54	/** Initialize Interval Timer. */
55	void it_init(void)	55	void it_init(void)
56	{	56	{
57	cr_itv_t itv;	57	cr_itv_t itv;
58		58
-		59	if(config.cpu_active==1)
-		60	{
59	irq_initialize(&it_irq);	61	irq_initialize(&it_irq);
60	it_irq.inr = INTERRUPT_TIMER;	62	it_irq.inr = INTERRUPT_TIMER;
61	it_irq.devno = device_assign_devno();	63	it_irq.devno = device_assign_devno();
62	it_irq.claim = it_claim;	64	it_irq.claim = it_claim;
63	it_irq.handler = it_interrupt;	65	it_irq.handler = it_interrupt;
64	irq_register(&it_irq);	66	irq_register(&it_irq);
-		67	}
65		68
66	/* initialize Interval Timer external interrupt vector */	69	/* initialize Interval Timer external interrupt vector */
67	itv.value = itv_read();	70	itv.value = itv_read();
68	itv.vector = INTERRUPT_TIMER;	71	itv.vector = INTERRUPT_TIMER;
69	itv.m = 0;	72	itv.m = 0;
70	itv_write(itv.value);	73	itv_write(itv.value);
71		74
72	/* set Interval Timer Counter to zero */	75	/* set Interval Timer Counter to zero */
73	itc_write(0);	76	itc_write(0);
74		77
75	/* generate first Interval Timer interrupt in IT_DELTA ticks */	78	/* generate first Interval Timer interrupt in IT_DELTA ticks */
76	itm_write(IT_DELTA);	79	itm_write(IT_DELTA);
77		80
78	/* propagate changes */	81	/* propagate changes */
79	srlz_d();	82	srlz_d();
80	}	83	}
81		84
82	/** Always claim ownership for this IRQ.	85	/** Always claim ownership for this IRQ.
83	*	86	*
84	* Other devices are responsible to avoid using INR 0.	87	* Other devices are responsible to avoid using INR 0.
85	*	88	*
86	* @return Always IRQ_ACCEPT.	89	* @return Always IRQ_ACCEPT.
87	*/	90	*/
88	irq_ownership_t it_claim(void)	91	irq_ownership_t it_claim(void)
89	{	92	{
90	return IRQ_ACCEPT;	93	return IRQ_ACCEPT;
91	}	94	}
92		95
93	/** Process Interval Timer interrupt. */	96	/** Process Interval Timer interrupt. */
94	void it_interrupt(irq_t irq, void arg, ...)	97	void it_interrupt(irq_t irq, void arg, ...)
95	{	98	{
96	int64_t c;	99	int64_t c;
97	int64_t m;	100	int64_t m;
98		101
99	eoi_write(EOI);	102	eoi_write(EOI);
100		103
101	m = itm_read();	104	m = itm_read();
102		105
103	while (1) {	106	while (1) {
104	c = itc_read();	107	c = itc_read();
105	c += IT_SERVICE_CLOCKS;	108	c += IT_SERVICE_CLOCKS;
106		109
107	m += IT_DELTA;	110	m += IT_DELTA;
108	if (m - c < 0)	111	if (m - c < 0)
109	CPU->missed_clock_ticks++;	112	CPU->missed_clock_ticks++;
110	else	113	else
111	break;	114	break;
112	}	115	}
113		116
114	itm_write(m);	117	itm_write(m);
115	srlz_d(); /* propagate changes */	118	srlz_d(); /* propagate changes */
116		119
117	/*	120	/*
118	* We are holding a lock which prevents preemption.	121	* We are holding a lock which prevents preemption.
119	* Release the lock, call clock() and reacquire the lock again.	122	* Release the lock, call clock() and reacquire the lock again.
120	*/	123	*/
121	spinlock_unlock(&irq->lock);	124	spinlock_unlock(&irq->lock);
122	clock();	125	clock();
123	spinlock_lock(&irq->lock);	126	spinlock_lock(&irq->lock);
124	}	127	}
125		128
126	/** @}	129	/** @}
127	*/	130	*/
128		131

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/ia64/src/drivers/it.c – Rev 2107 → 3578