source: trunk/kernel/devices/dev_txt.c @ 348

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

Several modifs in the generic scheduler and in the hal_context to
fix the context switch mechanism.

File size: 6.2 KB
RevLine 
[1]1/*
2 * dev_txt.c - TXT (Text Terminal) generic device API implementation.
[49]3 *
[1]4 * Author  Alain Greiner    (2016)
5 *
6 * Copyright (c) UPMC Sorbonne Universites
7 *
8 * This file is part of ALMOS-MK
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-kernel; if not, write to the Free Software Foundation,
21 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
22 */
23
24#include <hal_types.h>
25#include <hal_special.h>
26#include <hal_remote.h>
[77]27#include <hal_drivers.h>
[1]28#include <thread.h>
29#include <rpc.h>
30#include <printk.h>
31#include <dev_txt.h>
32
33/////////////////////////////////////////////////////////////////////////////////////////
34// Extern global variables
35/////////////////////////////////////////////////////////////////////////////////////////
36
[3]37extern chdev_directory_t  chdev_dir;         // allocated in kernel_init.c
[1]38
[188]39//////////////////////////////////
40void dev_txt_init( chdev_t * txt )
[1]41{
[188]42    // For all TXT channels other than the TXT0 (kernel terminal),
43    // the PIC chdev must be initialized before the TXT chdev, because
44    // the TXT chdev initialization requires the routing of an external IRQ
[1]45
[188]46    xptr_t    pic_xp  = chdev_dir.pic;
47    uint32_t  channel = txt->channel;
48    uint32_t  impl    = txt->impl;
[1]49
[188]50    assert( (pic_xp != XPTR_NULL) || (channel == 0) , __FUNCTION__ , 
51            "PIC not initialised before TXT" );
52
[23]53    // set chdev name
[188]54    snprintf( txt->name , 16 , "txt_%d" , channel );
[23]55
[245]56    // call driver init function
57    hal_drivers_txt_init(txt, impl);
[1]58
[255]59    // no server thread and no IRQ routing for TXT0 and IMPL_TXT_RS2 (multiplexed
60    // in software, not hardware)
61    if( channel != 0 && impl != IMPL_TXT_RS2 )
[188]62    {
63        // select a core to execute the TXT server thread
64        lid_t lid = cluster_select_local_core();
[3]65
[188]66        // bind TXT IRQ to the selected core
67        dev_pic_bind_irq( lid , txt );
[3]68
[188]69        // enable TXT IRQ
[238]70        dev_pic_enable_irq( lid , XPTR( local_cxy , txt ) );
[3]71
[188]72        // create server thread
73        thread_t * new_thread;
74        error_t    error;
[3]75
[188]76        error = thread_kernel_create( &new_thread,
77                                      THREAD_DEV,
78                                      &chdev_sequencial_server,
79                                      txt,
80                                      lid );
[3]81
[188]82        assert( (error == 0) , __FUNCTION__ , "cannot create server thread" );
[1]83
[188]84        // set "server" field in chdev descriptor
85        txt->server = new_thread;
[1]86
[188]87        // start server thread
[296]88        thread_block( new_thread , THREAD_BLOCKED_DEV_QUEUE );
[188]89        thread_unblock( XPTR( local_cxy , new_thread ) , THREAD_BLOCKED_GLOBAL );
90    }
[49]91}
[1]92
93//////////////////////////////////////////////////////////////////////////////////
[3]94// This static function is called by dev_txt_read(), dev_txt_write() functions.
[1]95////////////////////////////////////i/////////////////////////////////////////////
96static error_t dev_txt_access( uint32_t   type,
97                               uint32_t   channel,
98                               char     * buffer,
99                               uint32_t   count )
100{
101    thread_t * this = CURRENT_THREAD;
102
[49]103    txt_dmsg("\n[INFO] in %s : thread %x in process %x enters\n",
[1]104                 __FUNCTION__ , this->trdid , this->process->pid );
105
106    // check channel argument
[3]107    assert( (channel < CONFIG_MAX_TXT_CHANNELS) , __FUNCTION__ , "illegal channel index" );
[1]108
[3]109    // get extended pointer on remote TXT chdev descriptor
110    xptr_t  dev_xp = chdev_dir.txt[channel];
[1]111
[3]112    assert( (dev_xp != XPTR_NULL) , __FUNCTION__ , "undefined TXT chdev descriptor" );
[1]113
114    // register command in calling thread descriptor
[279]115    this->txt_cmd.dev_xp  = dev_xp;
116    this->txt_cmd.type    = type;
117    this->txt_cmd.buf_xp  = XPTR( local_cxy , buffer );
118    this->txt_cmd.count   = count;
[1]119
[3]120    // register client thread in waiting queue, activate server thread
121    // block client thread on THREAD_BLOCKED_IO and deschedule.
122    // it is re-activated by the ISR signaling IO operation completion.
123    chdev_register_command( dev_xp , this );
[1]124
[49]125    txt_dmsg("\n[INFO] in %s : thread %x in process %x completes / error = %d\n",
[279]126             __FUNCTION__ , this->trdid , this->process->pid , this->txt_cmd.error );
[1]127
128    // return I/O operation status from calling thread descriptor
[279]129    return this->txt_cmd.error;
[49]130}
[1]131
132/////////////////////////////////////////
133error_t dev_txt_write( uint32_t   channel,
134                       char     * buffer,
135                       uint32_t   count )
136{
137    return dev_txt_access( TXT_WRITE , channel , buffer , count );
138}
[49]139
[1]140/////////////////////////////////////////
141error_t dev_txt_read( uint32_t   channel,
142                      char     * buffer )
143{
144    return dev_txt_access( TXT_READ , channel , buffer , 1 );
145}
146
[3]147///////////////////////////////////////////////
148error_t dev_txt_sync_write( uint32_t   channel,
149                            char     * buffer,
150                            uint32_t   count )
[1]151{
[49]152    // get pointer on calling thread
[3]153    thread_t * this = CURRENT_THREAD;
[1]154
[49]155    // get extended pointer on TXT[0] chdev
[3]156    xptr_t  dev_xp = chdev_dir.txt[channel];
[1]157
[23]158    assert( (dev_xp != XPTR_NULL) , __FUNCTION__ , "undefined TXT0 chdev descriptor" );
159
[279]160    // register command in calling thread descriptor
161    this->txt_cmd.dev_xp  = dev_xp;
162    this->txt_cmd.type    = TXT_SYNC_WRITE;
163    this->txt_cmd.buf_xp  = XPTR( local_cxy , buffer );
164    this->txt_cmd.count   = count;
[1]165
[49]166    // get driver command function
[3]167    cxy_t       dev_cxy = GET_CXY( dev_xp );
168    chdev_t   * dev_ptr = (chdev_t *)GET_PTR( dev_xp );
169    dev_cmd_t * cmd = (dev_cmd_t *)hal_remote_lpt( XPTR( dev_cxy , &dev_ptr->cmd ) );
[1]170
[279]171    // call driver function
[3]172    cmd( XPTR( local_cxy , this ) );
[1]173
[3]174    // return I/O operation status from calling thread descriptor
[279]175    return this->txt_cmd.error;
[49]176}
[1]177
Note: See TracBrowser for help on using the repository browser.