gonzui

    1: /*
    2:  *----------------------------------------------------------------------
    3:  *    T2EX Software Package
    4:  *
    5:  *    Copyright 2012 by Ken Sakamura.
    6:  *    This software is distributed under the latest version of T-License 2.x.
    7:  *----------------------------------------------------------------------
    8:  *
    9:  *    Released by T-Engine Forum(http://www.t-engine.org/) at 2012/12/12.
   10:  *    Modified by TRON Forum(http://www.tron.org/) at 2015/06/04.
   11:  *
   12:  *----------------------------------------------------------------------
   13:  */
   14: /*
   15:  * This software package is available for use, modification, 
   16:  * and redistribution in accordance with the terms of the attached 
   17:  * T-License 2.x.
   18:  * If you want to redistribute the source code, you need to attach 
   19:  * the T-License 2.x document.
   20:  * There's no obligation to publish the content, and no obligation 
   21:  * to disclose it to the TRON Forum if you have modified the 
   22:  * software package.
   23:  * You can also distribute the modified source code. In this case, 
   24:  * please register the modification to T-Kernel traceability service.
   25:  * People can know the history of modifications by the service, 
   26:  * and can be sure that the version you have inherited some 
   27:  * modification of a particular version or not.
   28:  *
   29:  *    http://trace.tron.org/tk/?lang=en
   30:  *    http://trace.tron.org/tk/?lang=ja
   31:  *
   32:  * As per the provisions of the T-License 2.x, TRON Forum ensures that 
   33:  * the portion of the software that is copyrighted by Ken Sakamura or 
   34:  * the TRON Forum does not infringe the copyrights of a third party.
   35:  * However, it does not make any warranty other than this.
   36:  * DISCLAIMER: TRON Forum and Ken Sakamura shall not be held
   37:  * responsible for any consequences or damages caused directly or
   38:  * indirectly by the use of this software package.
   39:  *
   40:  * The source codes in bsd_source.tar.gz in this software package are 
   41:  * derived from NetBSD or OpenBSD and not covered under T-License 2.x.
   42:  * They need to be changed or redistributed according to the 
   43:  * representation of each source header.
   44:  */
   45: 
   46: /*
   47:  *      @(#)setspc.c (libtk/EM1-D512)
   48:  *
   49:  *      Address space control
   50:  */
   51: 
   52: #include <basic.h>
   53: #include <tk/tkernel.h>
   54: #include <tk/sysdef.h>
   55: #include "getsvcenv.h"
   56: 
   57: /*
   58:  * Set task address space
   59:  */
   60: EXPORT ER SetTaskSpace( ID taskid )
   61: {
   62:         UW     taskmode;
   63:         ER     ercd;
   64: 
   65:         if ( taskid == TSK_SELF ) {
   66:                 /* Set current CPL in RPL */
   67:                 taskmode = getsvcenv();
   68:                 SCInfo.taskmode ^= (taskmode ^ (taskmode << 16)) & TMF_PPL(3);
   69:         } else {
   70:                 T_EIT         r_eit;
   71:                 T_CREGS               r_cregs;
   72:                 T_TSKSPC      tskspc;
   73: 
   74:                 /* Get logical space/taskmode for taskid tasks */
   75:                 ercd = tk_get_reg(taskid, NULL, &r_eit, &r_cregs);
   76:                 if ( ercd < E_OK ) {
   77:                         goto err_ret;
   78:                 }
   79: 
   80:                 /* Change to logical space for nominated tasks */
   81:                 tskspc.uatb = r_cregs.uatb;
   82:                 tskspc.lsid = r_cregs.lsid;
   83:                 ercd = tk_set_tsp(TSK_SELF, &tskspc);
   84:                 if ( ercd < E_OK ) {
   85:                         goto err_ret;
   86:                 }
   87: 
   88:                 /* Change to PPL for nominated tasks */
   89:                 taskmode = getsvcenv();
   90:                 SCInfo.taskmode ^= (taskmode ^ r_eit.taskmode) & TMF_PPL(3);
   91:         }
   92: 
   93:         return E_OK;
   94: 
   95: err_ret:
   96:         return ercd;
   97: }