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

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

Fix bugs in hal_remote, hal uspace, hal_special

File size: 8.3 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                             uint32_t   max_size )
133
134{
135
136// TODO implement the max_size handling
137
138    uint32_t save_sr;
139    uint32_t src = (uint32_t)u_src;
140    uint32_t dst = (uint32_t)k_dst;
141
142    hal_disable_irq( &save_sr );
143
144    // loop on characters while non NUL
145    asm volatile(
146        "mfc2   $15,   $1           \n"   /* save current MMU_MODE          */
147        "1:                         \n"   /* loop entry                     */
148        "ori    $14,   $0,  0x7     \n" 
149        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
150        "lb         $13,   0(%0)        \n"   /* read char from user space      */
151        "mtc2   $15,   $1                       \n"   /* restore MMU_MODE               */
152            "sb     $13,   0(%1)        \n"   /* store char to kernel space     */
153        "addi   %0,    %0,  1       \n"   /* increment SRC pointer          */
154        "addi   %1,    %1,  1       \n"   /* increment DST pointer          */
155        "bne    $13,   $0,  1b      \n"   /* test NUL                       */
156        "nop                        \n"
157        : : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
158
159    hal_restore_irq( save_sr );
160
161} // hal_strcpy_from_uspace()
162
163////////////////////////////////////////////
164void hal_strcpy_to_uspace( char     * u_dst,
165                           char     * k_src,
166                           uint32_t   max_size )
167{
168
169// TODO implement the max_size handling
170
171    uint32_t save_sr;
172    uint32_t src = (uint32_t)k_src;
173    uint32_t dst = (uint32_t)u_dst;
174
175    hal_disable_irq( &save_sr );
176
177    // loop on characters while non NUL
178    asm volatile(
179        "mfc2   $15,   $1           \n"   /* save current MMU_MODE          */
180        "1:                         \n"   /* loop entry                     */
181        "lb         $13,   0(%0)        \n"   /* read char from kernel space    */
182        "ori    $14,   $0,  0x7     \n" 
183        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
184            "sb     $13,   0(%1)        \n"   /* store char to user space       */
185        "mtc2   $15,   $1                       \n"   /* restore MMU_MODE               */
186        "addi   %0,    %0,  1       \n"   /* increment SRC pointer          */
187        "addi   %1,    %1,  1       \n"   /* increment DST pointer          */
188        "bne    $13,   $0,  1b      \n"   /* test NUL                       */
189        "nop                        \n"
190        : : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
191
192    hal_restore_irq( save_sr );
193
194} // hal_strcpy_from_uspace()
195
196///////////////////////////////////////////////
197uint32_t hal_strlen_from_uspace( char * u_str )
198{
199    uint32_t save_sr;
200    uint32_t str      = (uint32_t)u_str;
201    uint32_t count    = 0;
202
203    hal_disable_irq( &save_sr ); 
204
205        asm volatile(
206        "ori    $15,   %0,   0      \n"   /* $15 <= count                   */
207        "ori    $13,   %1,   0      \n"   /* $13 <= str                     */
208   
209        "mfc2   $15,   $1           \n"   /* save   MMU_MODE                */
210        "ori    $14,   $0,   0x7    \n"   /* $14 <= mode DTLB on            */
211        "mtc2   $14,   $1                       \n"   /* MMU_MODE <= DTLB ON            */
212
213        "1:                         \n"
214        "lb         $13,   0(%0)        \n"   /* read char from kernel space    */
215        "addi   $13,   $13,  1      \n"   /* increment address              */
216        "bne    $13,   $0,   1b     \n"   /* loop until NUL found           */
217        "addi   $15,   $15,  1      \n"   /* increment counter              */
218
219        "mtc2   $14,   $1                       \n"   /* restore MMU_MODE               */
220        : "+r"(count) : "r"(str) : "$13","$14","$15" );
221
222    hal_restore_irq( save_sr );
223
224    return count;
225}
226
Note: See TracBrowser for help on using the repository browser.