1 | /////////////////////////////////////////////////////////////////////////////////// |
---|
2 | // File : tty_driver.c |
---|
3 | // Date : 23/05/2013 |
---|
4 | // Author : alain greiner |
---|
5 | // Copyright (c) UPMC-LIP6 |
---|
6 | /////////////////////////////////////////////////////////////////////////////////// |
---|
7 | |
---|
8 | #include <giet_config.h> |
---|
9 | #include <hard_config.h> |
---|
10 | #include <tty_driver.h> |
---|
11 | #include <xcu_driver.h> |
---|
12 | #include <ctx_handler.h> |
---|
13 | #include <utils.h> |
---|
14 | #include <tty0.h> |
---|
15 | |
---|
16 | #if !defined(SEG_TTY_BASE) |
---|
17 | # error: You must define SEG_TTY_BASE in the hard_config.h file |
---|
18 | #endif |
---|
19 | |
---|
20 | //////////////////////////////////////////////////////////////////////////////////// |
---|
21 | // extern variables |
---|
22 | //////////////////////////////////////////////////////////////////////////////////// |
---|
23 | |
---|
24 | // This variable is allocated in kernel_init.c file |
---|
25 | extern static_scheduler_t* _schedulers[X_SIZE][Y_SIZE][NB_PROCS_MAX]; |
---|
26 | |
---|
27 | //////////////////////////////////////////////////////////////////////////////////// |
---|
28 | // global variables |
---|
29 | //////////////////////////////////////////////////////////////////////////////////// |
---|
30 | |
---|
31 | __attribute__((section(".kdata"))) |
---|
32 | tty_fifo_t _tty_rx_fifo[NB_TTY_CHANNELS]; |
---|
33 | |
---|
34 | /* |
---|
35 | __attribute__((section(".kdata"))) |
---|
36 | unsigned int _tty_rx_buf[NB_TTY_CHANNELS]; |
---|
37 | |
---|
38 | __attribute__((section(".kdata"))) |
---|
39 | unsigned int _tty_rx_full[NB_TTY_CHANNELS]; |
---|
40 | |
---|
41 | __attribute__((section(".kdata"))) |
---|
42 | unsigned int _tty_rx_trdid[NB_TTY_CHANNELS]; |
---|
43 | */ |
---|
44 | |
---|
45 | //////////////////////////////////////////////////////////////////////////////////// |
---|
46 | // access functions |
---|
47 | //////////////////////////////////////////////////////////////////////////////////// |
---|
48 | |
---|
49 | ///////////////////////////////////////////////////// |
---|
50 | unsigned int _tty_get_register( unsigned int channel, |
---|
51 | unsigned int index ) |
---|
52 | { |
---|
53 | unsigned int* vaddr = (unsigned int*)SEG_TTY_BASE + channel*TTY_SPAN + index; |
---|
54 | return _io_extended_read( vaddr ); |
---|
55 | } |
---|
56 | |
---|
57 | ///////////////////////////////////////////// |
---|
58 | void _tty_set_register( unsigned int channel, |
---|
59 | unsigned int index, |
---|
60 | unsigned int value ) |
---|
61 | { |
---|
62 | unsigned int* vaddr = (unsigned int*)SEG_TTY_BASE + channel*TTY_SPAN + index; |
---|
63 | _io_extended_write( vaddr, value ); |
---|
64 | } |
---|
65 | |
---|
66 | ////////////////////////////////////// |
---|
67 | void _tty_init( unsigned int channel ) |
---|
68 | { |
---|
69 | _tty_rx_fifo[channel].sts = 0; |
---|
70 | _tty_rx_fifo[channel].ptr = 0; |
---|
71 | _tty_rx_fifo[channel].ptw = 0; |
---|
72 | } |
---|
73 | |
---|
74 | //////////////////////////////////////// |
---|
75 | void _tty_rx_isr( unsigned int irq_type, // HWI / WTI |
---|
76 | unsigned int irq_id, // index returned by XCU |
---|
77 | unsigned int channel ) // TTY channel |
---|
78 | { |
---|
79 | // get pointer on TTY_RX FIFO |
---|
80 | tty_fifo_t* fifo = &_tty_rx_fifo[channel]; |
---|
81 | |
---|
82 | // get character from TTY_RX channel and acknowledge IRQ |
---|
83 | unsigned int data = _tty_get_register( channel, TTY_READ ); |
---|
84 | |
---|
85 | // transfer character to FIFO if not full |
---|
86 | // discard incoming character if full |
---|
87 | if ( fifo->sts < TTY_FIFO_DEPTH ) |
---|
88 | { |
---|
89 | // store data into FIFO |
---|
90 | fifo->data[fifo->ptw] = (char)data; |
---|
91 | |
---|
92 | // avoid race |
---|
93 | asm volatile( "sync" ); |
---|
94 | |
---|
95 | // update FIFO state |
---|
96 | fifo->ptw = (fifo->ptw + 1) % TTY_FIFO_DEPTH; |
---|
97 | fifo->sts = fifo->sts + 1; |
---|
98 | } |
---|
99 | |
---|
100 | // get owner thread indexes |
---|
101 | unsigned int trdid = fifo->trdid; |
---|
102 | unsigned int x = (trdid >> 24) & 0xFF; |
---|
103 | unsigned int y = (trdid >> 16) & 0xFF; |
---|
104 | unsigned int p = (trdid >> 8) & 0xFF; |
---|
105 | unsigned int ltid = (trdid ) & 0xFF; |
---|
106 | |
---|
107 | // Reset NORUN_MASK_TTY bit |
---|
108 | static_scheduler_t* psched = (static_scheduler_t*)_schedulers[x][y][p]; |
---|
109 | unsigned int* ptr = &psched->context[ltid].slot[CTX_NORUN_ID]; |
---|
110 | _atomic_and( ptr , ~NORUN_MASK_TTY ); |
---|
111 | } |
---|
112 | |
---|
113 | ///////////////////////////////////////// |
---|
114 | void _tty_tx_isr( unsigned int irq_type, // HWI / WTI |
---|
115 | unsigned int irq_id, // index returned by XCU |
---|
116 | unsigned int channel ) // TTY channel |
---|
117 | { |
---|
118 | _printf("\n[GIET ERROR] the _tty_tx_isr() is not implemented\n"); |
---|
119 | _exit(); |
---|
120 | } |
---|
121 | |
---|
122 | // Local Variables: |
---|
123 | // tab-width: 4 |
---|
124 | // c-basic-offset: 4 |
---|
125 | // c-file-offsets:((innamespace . 0)(inline-open . 0)) |
---|
126 | // indent-tabs-mode: nil |
---|
127 | // End: |
---|
128 | // vim: filetype=c:expandtab:shiftwidth=4:tabstop=4:softtabstop=4 |
---|
129 | |
---|