source: trunk/hal/tsar_mips32/core/hal_uspace.c @ 95

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

Remove oldies.

File size: 8.1 KB
Line 
1/*
2 * hal_uspace.c - implementation of Generic User Space Access API for MIPS32
3 *
4 * Author  Mohamed Karaoui (2015)
5 *         Alain Greiner   (2016)
6 *
7 * Copyright (c) UPMC Sorbonne Universites
8 *
9 * This file is part of ALMOS-MKH..
10 *
11 * ALMOS-MKH. is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; version 2.0 of the License.
14 *
15 * ALMOS-MKH. is distributed in the hope that it will be useful, but
16 * WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
18 * General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with ALMOS-MKH.; if not, write to the Free Software Foundation,
22 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
23 */
24
25#include <hal_types.h>
26#include <hal_uspace.h>
27#include <hal_irqmask.h>
28
29///////////////////////////////////////////
30void hal_copy_from_uspace( void     * k_dst,
31                           void     * u_src,
32                           uint32_t   size )
33{
34    uint32_t save_sr;
35        uint32_t i;
36        uint32_t wsize;                        // number of words
37    uint32_t src = (uint32_t)u_src;
38    uint32_t dst = (uint32_t)k_dst;
39
40        if( (dst & 0x3) || (src & 0x3) ) wsize = 0;          // do it all in bytes
41    else                             wsize = size >> 2;
42
43    hal_disable_irq( &save_sr );
44
45        for( i = 0 ; i < wsize ; i++ )          // transfer one word per iteration
46        {
47        asm volatile(
48        "mfc2   $15,   $1           \n"   /* save   MMU_MODE                */
49        "ori    $14,   $0,  0x7     \n" 
50        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
51        "lw         $13,   0(%0)        \n"   /* read data from user space      */
52        "mtc2   $15,   $1                       \n"   /* restore MMU_MODE               */
53            "sw     $13,   0(%1)        \n"   /* store data to kernel space     */
54        : : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
55
56        src += 4;
57        dst += 4;
58    }
59
60        for( i = wsize << 2 ; i < size ; i++ )  // transfer one byte per iteration
61        {
62        asm volatile(
63        "mfc2   $15,   $1           \n"   /* save   MMU_MODE                */
64        "ori    $14,   $0,  0x7     \n" 
65        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
66        "lb         $13,   0(%0)        \n"   /* read data from user space      */
67        "mtc2   $15,   $1                       \n"   /* restore MMU_MODE               */
68            "sb     $13,   0(%1)        \n"   /* store data to kernel space     */
69        : : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
70
71        src += 1;
72        dst += 1;
73    }
74
75    hal_restore_irq( save_sr );
76
77}  // end hal_copy_from_uspace()
78
79///////////////////////////////////////////
80void hal_copy_to_uspace( void     * u_dst,
81                         void     * k_src,
82                         uint32_t   size )
83{
84    uint32_t save_sr;
85        uint32_t i;
86        uint32_t wsize;                   // number of words if aligned
87    uint32_t src = (uint32_t)k_src;
88    uint32_t dst = (uint32_t)u_dst;
89
90        if( (dst & 0x3) || (src & 0x3) ) wsize = 0;          // not aligned
91    else                             wsize = size >> 2;
92
93    hal_disable_irq( &save_sr );
94
95        for( i = 0 ; i < wsize ; i++ )          // transfer one word per iteration
96        {
97        asm volatile(
98        "mfc2   $15,   $1           \n"   /* save   MMU_MODE                */
99        "lw         $13,   0(%0)        \n"   /* read data from kernel space    */
100        "ori    $14,   $0,  0x7     \n" 
101        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
102            "sw     $13,   0(%1)        \n"   /* store data to user space       */
103        "mtc2   $15,   $1                       \n"   /* restore MMU_MODE               */
104        : : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
105
106        src += 4;
107        dst += 4;
108    }
109
110        for( i = wsize << 2 ; i < size ; i++ )  // transfer one byte per iteration
111        {
112        asm volatile(
113        "mfc2   $15,   $1           \n"   /* save   MMU_MODE                */
114        "lw         $13,   0(%0)        \n"   /* read data from kernel space    */
115        "ori    $14,   $0,  0x7     \n" 
116        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
117            "sb     $13,   0(%1)        \n"   /* store data to user space       */
118        "mtc2   $15,   $1                       \n"   /* restore MMU_MODE               */
119        : : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
120
121        src += 1;
122        dst += 1;
123    }
124
125    hal_restore_irq( save_sr );
126
127}  // end hal_copy_to_uspace()
128
129//////////////////////////////////////////
130void hal_strcpy_from_uspace( char * k_dst,
131                             char * u_src )
132
133{
134    uint32_t save_sr;
135    uint32_t src = (uint32_t)u_src;
136    uint32_t dst = (uint32_t)k_dst;
137
138    hal_disable_irq( &save_sr );
139
140    // loop on characters while non NUL
141    asm volatile(
142        "mfc2   $15,   $1           \n"   /* save current MMU_MODE          */
143        "1:                         \n"   /* loop entry                     */
144        "ori    $14,   $0,  0x7     \n" 
145        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
146        "lb         $13,   0(%0)        \n"   /* read char from user space      */
147        "mtc2   $15,   $1                       \n"   /* restore MMU_MODE               */
148            "sb     $13,   0(%1)        \n"   /* store char to kernel space     */
149        "addi   %0,    %0,  1       \n"   /* increment SRC pointer          */
150        "addi   %1,    %1,  1       \n"   /* increment DST pointer          */
151        "bne    $13,   $0,  1b      \n"   /* test NUL                       */
152        "nop                        \n"
153        : : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
154
155    hal_restore_irq( save_sr );
156
157} // hal_strcpy_from_uspace()
158
159//////////////////////////////////////////
160void hal_strcpy_to_uspace( char * u_dst,
161                           char * k_src )
162
163{
164    uint32_t save_sr;
165    uint32_t src = (uint32_t)k_src;
166    uint32_t dst = (uint32_t)u_dst;
167
168    hal_disable_irq( &save_sr );
169
170    // loop on characters while non NUL
171    asm volatile(
172        "mfc2   $15,   $1           \n"   /* save current MMU_MODE          */
173        "1:                         \n"   /* loop entry                     */
174        "lb         $13,   0(%0)        \n"   /* read char from kernel space    */
175        "ori    $14,   $0,  0x7     \n" 
176        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
177            "sb     $13,   0(%1)        \n"   /* store char to user space       */
178        "mtc2   $15,   $1                       \n"   /* restore MMU_MODE               */
179        "addi   %0,    %0,  1       \n"   /* increment SRC pointer          */
180        "addi   %1,    %1,  1       \n"   /* increment DST pointer          */
181        "bne    $13,   $0,  1b      \n"   /* test NUL                       */
182        "nop                        \n"
183        : : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
184
185    hal_restore_irq( save_sr );
186
187} // hal_strcpy_from_uspace()
188
189///////////////////////////////////////////////
190uint32_t hal_strlen_from_uspace( char * u_str )
191{
192    uint32_t save_sr;
193    uint32_t str      = (uint32_t)u_str;
194    uint32_t count    = 0;
195
196    hal_disable_irq( &save_sr ); 
197
198        asm volatile(
199        "ori    $15,   %0,   0      \n"   /* $15 <= count                   */
200        "ori    $13,   %1,   0      \n"   /* $13 <= str                     */
201   
202        "mfc2   $15,   $1           \n"   /* save   MMU_MODE                */
203        "ori    $14,   $0,   0x7    \n"   /* $14 <= mode DTLB on            */
204        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
205
206        "1:                         \n"
207        "lb         $13,   0(%0)        \n"   /* read char from kernel space    */
208        "addi   $13,   $13,  1      \n"   /* increment address              */
209        "bne    $13,   $0,   1b     \n"   /* loop until NUL found           */
210        "addi   $15,   $15,  1      \n"   /* increment counter              */
211
212        "mtc2   $14,   $1                       \n"   /* restore MMU_MODE               */
213        : "+r"(count) : "r"(str) : "$13","$14","$15" );
214
215    hal_restore_irq( save_sr );
216
217    return count;
218}
219
Note: See TracBrowser for help on using the repository browser.