Subversion Repositories HelenOS

Rev

Rev 2107 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 2107 Rev 3672
Line 43... Line 43...
43 
#include <arch.h>
 43 
#include <arch.h>
44 
#include <debug.h>
 44 
#include <debug.h>
45 
 
 45 
 
46 
#define TICK_RESTART_TIME   50  /* Worst case estimate. */
 46 
#define TICK_RESTART_TIME   50  /* Worst case estimate. */
47 
 
 47 
 
48 
/** Initialize tick interrupt. */
 48 
/** Initialize tick and stick interrupt. */
49 
void tick_init(void)
 49 
void tick_init(void)
50 
{
 50 
{
- 
 
 51 
    /* initialize TICK interrupt */
51 
    tick_compare_reg_t compare;
 52 
    tick_compare_reg_t compare;
52 
   
 53 
 
53 
    interrupt_register(14, "tick_int", tick_interrupt);
 54 
    interrupt_register(14, "tick_int", tick_interrupt);
54 
    compare.int_dis = false;
 55 
    compare.int_dis = false;
55 
    compare.tick_cmpr = CPU->arch.clock_frequency / HZ;
 56 
    compare.tick_cmpr = CPU->arch.clock_frequency / HZ;
56 
    CPU->arch.next_tick_cmpr = compare.tick_cmpr;
 57 
    CPU->arch.next_tick_cmpr = compare.tick_cmpr;
57 
    tick_compare_write(compare.value);
 58 
    tick_compare_write(compare.value);
58 
    tick_write(0);
 59 
    tick_write(0);
- 
 
 60 
 
- 
 
 61 
#if defined (US3)
- 
 
 62 
    /* disable STICK interrupts and clear any pending ones */
- 
 
 63 
    tick_compare_reg_t stick_compare;
- 
 
 64 
    softint_reg_t clear;
- 
 
 65 
 
- 
 
 66 
    stick_compare.value = stick_compare_read();
- 
 
 67 
    stick_compare.int_dis = true;
- 
 
 68 
    stick_compare.tick_cmpr = 0;
- 
 
 69 
    stick_compare_write(stick_compare.value);
- 
 
 70 
 
- 
 
 71 
    clear.value = 0;
- 
 
 72 
    clear.stick_int = 1;
- 
 
 73 
    clear_softint_write(clear.value);
- 
 
 74 
#endif
59 
}
 75 
}
60 
 
 76 
 
61 
/** Process tick interrupt.
 77 
/** Process tick interrupt.
62 
 *
 78 
 *
63 
 * @param n Interrupt Level, 14,  (can be ignored)
 79 
 * @param n Interrupt Level, 14,  (can be ignored)
Line 65... Line 81...
65 
 */
 81 
 */
66 
void tick_interrupt(int n, istate_t *istate)
 82 
void tick_interrupt(int n, istate_t *istate)
67 
{
 83 
{
68 
    softint_reg_t softint, clear;
 84 
    softint_reg_t softint, clear;
69 
    uint64_t drift;
 85 
    uint64_t drift;
70 
   
 86 
 
71 
    softint.value = softint_read();
 87 
    softint.value = softint_read();
72 
   
 88 
   
73 
    /*
 89 
    /*
74 
     * Make sure we are servicing interrupt_level_14
 90 
     * Make sure we are servicing interrupt_level_14
75 
     */
 91 
     */