source: trunk/kernel/kern/chdev.c @ 407

Last change on this file since 407 was 407, checked in by alain, 7 years ago

First implementation of fork/exec.

File size: 13.0 KB
Line 
1/*
2 * chdev.c - channel device descriptor operations implementation.
3 *
4 * Authors  Alain Greiner   (2016)
5 *
6 * Copyright (c) UPMC Sorbonne Universites
7 *
8 * This file is part of ALMOS-MKH.
9 *
10 * ALMOS-MKH.is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; version 2.0 of the License.
13 *
14 * ALMOS-MKH.is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17 * General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with ALMOS-MKH.; if not, write to the Free Software Foundation,
21 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
22 */
23
24#include <kernel_config.h>
25#include <hal_types.h>
26#include <hal_special.h>
27#include <hal_irqmask.h>
28#include <printk.h>
29#include <boot_info.h>
30#include <xlist.h>
31#include <kmem.h>
32#include <scheduler.h>
33#include <thread.h>
34#include <rpc.h>
35#include <chdev.h>
36#include <devfs.h>
37
38
39extern chdev_directory_t    chdev_dir;   // allocated in kernel_init.c
40
41#if CONFIG_READ_DEBUG
42extern uint32_t enter_chdev_cmd;
43extern uint32_t exit_chdev_cmd;
44extern uint32_t enter_chdev_server;
45extern uint32_t exit_chdev_server;
46#endif
47
48////////////////////////////////////////////
49char * chdev_func_str( uint32_t func_type ) 
50{
51        if     ( func_type == DEV_FUNC_RAM ) return "RAM";
52        else if( func_type == DEV_FUNC_ROM ) return "ROM";
53        else if( func_type == DEV_FUNC_FBF ) return "FBF";
54        else if( func_type == DEV_FUNC_IOB ) return "IOB";
55        else if( func_type == DEV_FUNC_IOC ) return "IOC";
56        else if( func_type == DEV_FUNC_MMC ) return "MMC";
57        else if( func_type == DEV_FUNC_DMA ) return "DMA";
58        else if( func_type == DEV_FUNC_NIC ) return "NIC";
59        else if( func_type == DEV_FUNC_TIM ) return "TIM";
60        else if( func_type == DEV_FUNC_TXT ) return "TXT";
61        else if( func_type == DEV_FUNC_ICU ) return "ICU";
62        else if( func_type == DEV_FUNC_PIC ) return "PIC";
63    else                                 return "undefined";
64}
65
66/////////////////////////////////////////
67chdev_t * chdev_create( uint32_t    func,
68                        uint32_t    impl,
69                        uint32_t    channel,
70                        uint32_t    is_rx,
71                        xptr_t      base )
72{
73    chdev_t    * chdev;
74    kmem_req_t   req;
75
76    // allocate memory for chdev
77    req.type   = KMEM_DEVICE;
78    req.flags  = AF_ZERO;
79    chdev      = (chdev_t *)kmem_alloc( &req );
80
81    if( chdev == NULL ) return NULL;
82
83    // initialize waiting threads queue and associated lock
84    remote_spinlock_init( XPTR( local_cxy , &chdev->wait_lock ) );
85    xlist_root_init( XPTR( local_cxy , &chdev->wait_root ) );
86
87    // initialize attributes
88    chdev->func    =  func;
89    chdev->impl    =  impl;
90    chdev->channel =  channel;
91    chdev->is_rx   =  is_rx;
92    chdev->base    =  base; 
93
94    return chdev;
95
96}  // end chdev_create()
97
98///////////////////////////////////
99void chdev_print( chdev_t * chdev )
100{
101    printk("\n - func      = %s"
102           "\n - channel   = %d"
103           "\n - base      = %l"
104           "\n - cmd       = %x"
105           "\n - isr       = %x"
106           "\n - chdev     = %x\n",
107           chdev_func_str(chdev->func),
108           chdev->channel,
109           chdev->base,
110           chdev->cmd,
111           chdev->isr,
112           chdev );
113}
114
115//////////////////////////////////////////////////
116void chdev_register_command( xptr_t     chdev_xp )
117{
118    thread_t * server_ptr;    // local pointer on server thread associated to chdev
119    core_t   * core_ptr;      // local pointer on core running the server thread
120    uint32_t   lid;           // core running the server thread local index
121    xptr_t     lock_xp;       // extended pointer on lock protecting the chdev queue
122    uint32_t   modified;      // non zero if the server thread state was modified
123    uint32_t   save_sr;       // for critical section
124
125    thread_t * this = CURRENT_THREAD;
126
127chdev_dmsg("\n[DBG] %s : core[%x,%d] (thread %s) enter / cycle %d\n",
128__FUNCTION__, local_cxy, this->core->lid, thread_type_str(this->type) , hal_time_stamp() );
129
130    // get device descriptor cluster and local pointer
131    cxy_t     chdev_cxy = GET_CXY( chdev_xp );
132    chdev_t * chdev_ptr = (chdev_t *)GET_PTR( chdev_xp );
133
134    // build extended pointers on client thread xlist and device root
135    xptr_t  list_xp = XPTR( local_cxy , &this->wait_list );
136    xptr_t  root_xp = XPTR( chdev_cxy , &chdev_ptr->wait_root );
137
138    // get local pointer on server thread
139    server_ptr = (thread_t *)hal_remote_lpt( XPTR( chdev_cxy , &chdev_ptr->server) );
140
141chdev_dmsg("\n[DBG] %s : core[%x,%d] (thread %s) / server_cxy %x / server_ptr %x / server_type %\n",
142__FUNCTION__, local_cxy, this->core->lid, server_cxy, server_ptr,
143thread_type_str( hal_remote_lw( XPTR( server_cxy , &server_ptr->type) ) ) );
144
145    // build extended pointer on chdev lock protecting queue
146    lock_xp = XPTR( chdev_cxy , &chdev_ptr->wait_lock );
147
148    // get local pointer on core running the server thread
149    core_ptr = (core_t *)hal_remote_lpt( XPTR( chdev_cxy , &server_ptr->core ) );
150
151    // get core local index
152    lid = hal_remote_lw( XPTR( chdev_cxy , &core_ptr->lid ) );
153
154    // enter critical section
155    hal_disable_irq( &save_sr );
156
157    // register client thread in waiting queue
158    remote_spinlock_lock( lock_xp );
159    xlist_add_last( root_xp , list_xp );
160    remote_spinlock_unlock( lock_xp );
161
162    // unblock server thread
163    modified = thread_unblock( XPTR( chdev_cxy , server_ptr ), THREAD_BLOCKED_DEV_QUEUE );
164
165    // send IPI to core running the server thread
166    if( modified ) dev_pic_send_ipi( chdev_cxy , lid ); 
167   
168    // block client thread
169    assert( thread_can_yield( this ) , __FUNCTION__ , "illegal sched_yield\n" );
170
171chdev_dmsg("\n[DBG] %s : core[%x,%d] (thread %s) deschedules / cycle %d\n",
172__FUNCTION__, local_cxy, this->core->lid, thread_type_str(this->type) , hal_time_stamp() );
173
174    thread_block( CURRENT_THREAD , THREAD_BLOCKED_IO );
175    sched_yield();
176
177chdev_dmsg("\n[DBG] %s : core[%x,%d] (thread %s) resumes / cycle %d\n",
178__FUNCTION__, local_cxy, this->core->lid, thread_type_str(this->type) , hal_time_stamp() );
179
180    // exit critical section
181    hal_restore_irq( save_sr );
182
183}  // end chdev_register_command()
184
185///////////////////////////////////////////////
186void chdev_sequencial_server( chdev_t * chdev )
187{
188    xptr_t          client_xp;    // extended pointer on waiting thread
189    cxy_t           client_cxy;   // cluster of client thread
190    thread_t      * client_ptr;   // local pointer on client thread
191    thread_t      * server;       // local pointer on server thread
192    xptr_t          root_xp;      // extended pointer on device waiting queue root
193    xptr_t          lock_xp;      // extended pointer on lock ptotecting chdev queue
194
195    server = CURRENT_THREAD;
196
197chdev_dmsg("\n[DBG] %s : enter / server = %x / chdev = %x / cycle %d\n",
198__FUNCTION__ , server , chdev , hal_time_stamp() );
199
200    root_xp = XPTR( local_cxy , &chdev->wait_root );
201    lock_xp = XPTR( local_cxy , &chdev->wait_lock );
202
203        // This infinite loop is executed by the DEV thread
204    // to handle commands registered in the chdev queue.
205    while( 1 )
206    {
207        // get the lock protecting the waiting queue
208        remote_spinlock_lock( lock_xp );
209
210        // check waiting queue state
211        if( xlist_is_empty( root_xp ) ) // waiting queue empty
212        {
213            // release lock
214            remote_spinlock_unlock( lock_xp );
215
216chdev_dmsg("\n[DBG] %s : thread %x deschedule /cycle %d\n",
217__FUNCTION__ , server , hal_time_stamp() );
218
219            // block and deschedule
220            thread_block( server , THREAD_BLOCKED_DEV_QUEUE );
221            sched_yield();
222
223chdev_dmsg("\n[DBG] %s : thread %x resume /cycle %d\n",
224__FUNCTION__ , server , hal_time_stamp() );
225
226        } 
227        else                            // waiting queue not empty
228        {
229
230#if CONFIG_READ_DEBUG
231enter_chdev_server = hal_time_stamp();
232#endif
233            // release lock
234            remote_spinlock_unlock( lock_xp );
235
236            // get extended pointer on first client thread
237            client_xp = XLIST_FIRST_ELEMENT( root_xp , thread_t , wait_list );
238
239            // get client thread cluster, local pointer, and identifier
240            client_cxy = GET_CXY( client_xp );
241            client_ptr = (thread_t *)GET_PTR( client_xp );
242
243            // call driver command function to execute I/O operation
244            chdev->cmd( client_xp );
245       
246            // remove the client thread from waiting queue
247            remote_spinlock_lock( lock_xp );
248            xlist_unlink( XPTR( client_cxy , &client_ptr->wait_list ) );
249            remote_spinlock_unlock( lock_xp );
250
251chdev_dmsg("\n[DBG] %s : thread %x complete operation for client %x / cycle %d\n",
252__FUNCTION__ , server , client_ptr , hal_time_stamp() );
253
254#if CONFIG_READ_DEBUG
255exit_chdev_server = hal_time_stamp();
256#endif
257
258        }
259    }  // end while
260}  // end chdev_sequencial_server()
261
262////////////////////////
263void chdev_dir_display()
264{
265    cxy_t     iob_cxy  = GET_CXY( chdev_dir.iob );
266    chdev_t * iob_ptr  = (chdev_t *)GET_PTR( chdev_dir.iob );
267    uint32_t  iob_base = (uint32_t)hal_remote_lwd( XPTR( iob_cxy , &iob_ptr->base ) );
268
269    cxy_t     pic_cxy  = GET_CXY( chdev_dir.pic );
270    chdev_t * pic_ptr  = (chdev_t *)GET_PTR( chdev_dir.pic );
271    uint32_t  pic_base = (uint32_t)hal_remote_lwd( XPTR( pic_cxy , &pic_ptr->base ) );
272
273    cxy_t     txt0_tx_cxy  = GET_CXY( chdev_dir.txt_tx[0] );
274    chdev_t * txt0_tx_ptr  = (chdev_t *)GET_PTR( chdev_dir.txt_tx[0] );
275    uint32_t  txt0_tx_base = (uint32_t)hal_remote_lwd( XPTR( txt0_tx_cxy , &txt0_tx_ptr->base ) );
276
277    cxy_t     txt0_rx_cxy  = GET_CXY( chdev_dir.txt_rx[0] );
278    chdev_t * txt0_rx_ptr  = (chdev_t *)GET_PTR( chdev_dir.txt_rx[0] );
279    uint32_t  txt0_rx_base = (uint32_t)hal_remote_lwd( XPTR( txt0_rx_cxy , &txt0_rx_ptr->base ) );
280
281    cxy_t     txt1_tx_cxy  = GET_CXY( chdev_dir.txt_tx[1] );
282    chdev_t * txt1_tx_ptr  = (chdev_t *)GET_PTR( chdev_dir.txt_tx[1] );
283    uint32_t  txt1_tx_base = (uint32_t)hal_remote_lwd( XPTR( txt1_tx_cxy , &txt1_tx_ptr->base ) );
284
285    cxy_t     txt1_rx_cxy  = GET_CXY( chdev_dir.txt_rx[1] );
286    chdev_t * txt1_rx_ptr  = (chdev_t *)GET_PTR( chdev_dir.txt_rx[1] );
287    uint32_t  txt1_rx_base = (uint32_t)hal_remote_lwd( XPTR( txt1_rx_cxy , &txt1_rx_ptr->base ) );
288
289    cxy_t     txt2_tx_cxy  = GET_CXY( chdev_dir.txt_tx[2] );
290    chdev_t * txt2_tx_ptr  = (chdev_t *)GET_PTR( chdev_dir.txt_tx[2] );
291    uint32_t  txt2_tx_base = (uint32_t)hal_remote_lwd( XPTR( txt2_tx_cxy , &txt2_tx_ptr->base ) );
292
293    cxy_t     txt2_rx_cxy  = GET_CXY( chdev_dir.txt_rx[2] );
294    chdev_t * txt2_rx_ptr  = (chdev_t *)GET_PTR( chdev_dir.txt_rx[2] );
295    uint32_t  txt2_rx_base = (uint32_t)hal_remote_lwd( XPTR( txt2_rx_cxy , &txt2_rx_ptr->base ) );
296
297    cxy_t     ioc_cxy  = GET_CXY( chdev_dir.ioc[0] );
298    chdev_t * ioc_ptr  = (chdev_t *)GET_PTR( chdev_dir.ioc[0] );
299    uint32_t  ioc_base = (uint32_t)hal_remote_lwd( XPTR( ioc_cxy , &ioc_ptr->base ) );
300
301    cxy_t     fbf_cxy  = GET_CXY( chdev_dir.fbf[0] );
302    chdev_t * fbf_ptr  = (chdev_t *)GET_PTR( chdev_dir.fbf[0] );
303    uint32_t  fbf_base = (uint32_t)hal_remote_lwd( XPTR( fbf_cxy , &fbf_ptr->base ) );
304
305    cxy_t     nic0_rx_cxy  = GET_CXY( chdev_dir.nic_rx[0] );
306    chdev_t * nic0_rx_ptr  = (chdev_t *)GET_PTR( chdev_dir.nic_rx[0] );
307    uint32_t  nic0_rx_base = (uint32_t)hal_remote_lwd( XPTR( nic0_rx_cxy , &nic0_rx_ptr->base ) );
308
309    cxy_t     nic0_tx_cxy  = GET_CXY( chdev_dir.nic_tx[0] );
310    chdev_t * nic0_tx_ptr  = (chdev_t *)GET_PTR( chdev_dir.nic_tx[0] );
311    uint32_t  nic0_tx_base = (uint32_t)hal_remote_lwd( XPTR( nic0_tx_cxy , &nic0_tx_ptr->base ) );
312
313    printk("\n***** external chdev directory in cluster %x\n"
314           "  - iob       : cxy = %X / ptr = %X / base = %X\n"
315           "  - pic       : cxy = %X / ptr = %X / base = %X\n"
316           "  - ioc       : cxy = %X / ptr = %X / base = %X\n"
317           "  - fbf       : cxy = %X / ptr = %X / base = %X\n"
318           "  - txt_rx[0] : cxy = %X / ptr = %X / base = %X\n"
319           "  - txt_tx[0] : cxy = %X / ptr = %X / base = %X\n"
320           "  - txt_rx[1] : cxy = %X / ptr = %X / base = %X\n"
321           "  - txt_tx[1] : cxy = %X / ptr = %X / base = %X\n"
322           "  - txt_rx[2] : cxy = %X / ptr = %X / base = %X\n"
323           "  - txt_tx[2] : cxy = %X / ptr = %X / base = %X\n"
324           "  - nic_rx[0] : cxy = %X / ptr = %X / base = %X\n"
325           "  - nic_tx[0] : cxy = %X / ptr = %X / base = %X\n",
326           local_cxy,
327           iob_cxy , iob_ptr , iob_base ,
328           pic_cxy , pic_ptr , pic_base ,
329           ioc_cxy , ioc_ptr , ioc_base ,
330           fbf_cxy , fbf_ptr , fbf_base ,
331           txt0_rx_cxy , txt0_rx_ptr , txt0_rx_base ,
332           txt0_tx_cxy , txt0_tx_ptr , txt0_tx_base ,
333           txt1_rx_cxy , txt1_rx_ptr , txt1_rx_base ,
334           txt1_tx_cxy , txt1_tx_ptr , txt1_tx_base ,
335           txt2_rx_cxy , txt2_rx_ptr , txt2_rx_base ,
336           txt2_tx_cxy , txt2_tx_ptr , txt2_tx_base ,
337           nic0_rx_cxy , nic0_rx_ptr , nic0_rx_base ,
338           nic0_tx_cxy , nic0_tx_ptr , nic0_tx_base );
339
340}  // end chdev_dir_display()
341
Note: See TracBrowser for help on using the repository browser.