Context Navigation

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

Last change on this file since 443 was 425, checked in by alain, 7 years ago
bloup
File size: 9.6 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 <errno.h>
26	#include <vmm.h>
27	#include <hal_types.h>
28	#include <hal_uspace.h>
29	#include <hal_irqmask.h>
30
31	#include <printk.h>
32	#include <thread.h>
33
34	///////////////////////////////////////////
35	void hal_copy_from_uspace( void * k_dst,
36	void * u_src,
37	uint32_t size )
38	{
39	uint32_t save_sr;
40	uint32_t i;
41	uint32_t wsize; // number of words
42	uint32_t src = (uint32_t)u_src;
43	uint32_t dst = (uint32_t)k_dst;
44
45	if( (dst & 0x3) \|\| (src & 0x3) ) wsize = 0; // do it all in bytes
46	else wsize = size >> 2;
47
48	hal_disable_irq( &save_sr );
49
50
51	for( i = 0 ; i < wsize ; i++ ) // transfer one word per iteration
52	{
53	asm volatile(
54	"mfc2 $15, $1 \n" /* save MMU_MODE */
55	"ori $14, $0, 0x7 \n"
56	"mtc2 $14, $1 \n" /* MMU_MODE <= DTLB ON */
57	"lw $13, 0(%0) \n" /* read data from user space */
58	"mtc2 $15, $1 \n" /* restore MMU_MODE */
59	"sw $13, 0(%1) \n" /* store data to kernel space */
60	: : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
61
62	src += 4;
63	dst += 4;
64	}
65
66	for( i = wsize << 2 ; i < size ; i++ ) // transfer one byte per iteration
67	{
68	asm volatile(
69	"mfc2 $15, $1 \n" /* save MMU_MODE */
70	"ori $14, $0, 0x7 \n"
71	"mtc2 $14, $1 \n" /* MMU_MODE <= DTLB ON */
72	"lb $13, 0(%0) \n" /* read data from user space */
73	"mtc2 $15, $1 \n" /* restore MMU_MODE */
74	"sb $13, 0(%1) \n" /* store data to kernel space */
75	: : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
76
77	src += 1;
78	dst += 1;
79	}
80
81	hal_restore_irq( save_sr );
82
83	} // end hal_copy_from_uspace()
84
85	///////////////////////////////////////////
86	void hal_copy_to_uspace( void * u_dst,
87	void * k_src,
88	uint32_t size )
89	{
90	uint32_t save_sr;
91	uint32_t i;
92	uint32_t wsize; // number of words if aligned
93	uint32_t src = (uint32_t)k_src;
94	uint32_t dst = (uint32_t)u_dst;
95
96	if( (dst & 0x3) \|\| (src & 0x3) ) wsize = 0; // not aligned
97	else wsize = size >> 2;
98
99	hal_disable_irq( &save_sr );
100
101	for( i = 0 ; i < wsize ; i++ ) // transfer one word per iteration
102	{
103	asm volatile(
104	"mfc2 $15, $1 \n" /* save MMU_MODE */
105	"lw $13, 0(%0) \n" /* read data from kernel space */
106	"ori $14, $0, 0x7 \n"
107	"mtc2 $14, $1 \n" /* MMU_MODE <= DTLB ON */
108	"sw $13, 0(%1) \n" /* store data to user space */
109	"mtc2 $15, $1 \n" /* restore MMU_MODE */
110	: : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
111
112	src += 4;
113	dst += 4;
114	}
115
116	for( i = wsize << 2 ; i < size ; i++ ) // transfer one byte per iteration
117	{
118	asm volatile(
119	"mfc2 $15, $1 \n" /* save MMU_MODE */
120	"lw $13, 0(%0) \n" /* read data from kernel space */
121	"ori $14, $0, 0x7 \n"
122	"mtc2 $14, $1 \n" /* MMU_MODE <= DTLB ON */
123	"sb $13, 0(%1) \n" /* store data to user space */
124	"mtc2 $15, $1 \n" /* restore MMU_MODE */
125	: : "r"( src ) , "r"( dst ) : "$13","$14","$15", "memory" );
126
127	src += 1;
128	dst += 1;
129	}
130
131	hal_restore_irq( save_sr );
132
133	} // end hal_copy_to_uspace()
134
135	//////////////////////////////////////////////
136	void hal_strcpy_from_uspace( char * k_dst,
137	char * u_src,
138	uint32_t size )
139	{
140	uint32_t save_sr;
141	uint32_t src = (uint32_t)u_src;
142	uint32_t dst = (uint32_t)k_dst;
143
144	hal_disable_irq( &save_sr );
145
146	// loop on characters while ( (character != NUL) and (count < size ) )
147	asm volatile(
148	".set noreorder \n"
149	"move $11, %0 \n" /* $11 <= count == size */
150	"move $12, %1 \n" /* $12 <= u_src */
151	"move $13, %2 \n" /* $13 <= k_dst */
152	"mfc2 $15, $1 \n" /* $15 <= mode DTLB and ITLB off */
153	"ori $14, $15, 0x4 \n" /* $14 <= mode DTLB on */
154	"1: \n"
155	"mtc2 $14, $1 \n" /* MMU_MODE <= DTLB ON */
156	"lb $10, 0($12) \n" /* read char from user space */
157	"mtc2 $15, $1 \n" /* restore DTLB and ITLB off */
158	"sb $10, 0($13) \n" /* store char to kernel space */
159	"beq $10, $0, 2f \n" /* exit if char = 0 */
160	"addi $11, $11, -1 \n" /* decrement count */
161	"addi $12, $12, 1 \n" /* increment u_src pointer */
162	"beq $11, $0, 2f \n" /* exit if count == 0 */
163	"addi $13, $13, 1 \n" /* increment k_src pointer */
164	"j 1b \n" /* jump to next iteration */
165	"2: \n"
166	"nop \n"
167	".set reorder \n"
168	:
169	: "r"(size),"r"(src),"r"(dst)
170	: "$10","$11","$12","$13","$14","$15" );
171
172	hal_restore_irq( save_sr );
173
174	} // hal_strcpy_from_uspace()
175
176	////////////////////////////////////////////
177	void hal_strcpy_to_uspace( char * u_dst,
178	char * k_src,
179	uint32_t size )
180	{
181	uint32_t save_sr;
182	uint32_t src = (uint32_t)k_src;
183	uint32_t dst = (uint32_t)u_dst;
184
185	hal_disable_irq( &save_sr );
186
187	// loop on characters while ( (character != NUL) and (count < size) )
188	asm volatile(
189	".set noreorder \n"
190	"move $11, %0 \n" /* $11 <= count == size */
191	"move $12, %1 \n" /* $12 <= k_src */
192	"move $13, %2 \n" /* $13 <= u_dst */
193	"mfc2 $15, $1 \n" /* $15 <= mode DTLB and ITLB off */
194	"ori $14, $15, 0x4 \n" /* $14 <= mode DTLB on */
195	"1: \n"
196	"lb $10, 0($12) \n" /* read char from kernel space */
197	"mtc2 $14, $1 \n" /* MMU_MODE <= DTLB ON */
198	"sb $10, 0($13) \n" /* store char to user space */
199	"mtc2 $15, $1 \n" /* restore DTLB and ITLB off */
200	"beq $10, $0, 2f \n" /* exit if char == 0 */
201	"addi $11, $11, -1 \n" /* decrement count */
202	"addi $12, $12, 1 \n" /* increment k_src pointer */
203	"beq $11, $0, 2f \n" /* exit if count == size */
204	"addi $13, $13, 1 \n" /* increment u_src pointer */
205	"j 1b \n" /* jump to next iteration */
206	"2: \n"
207	"nop \n"
208	".set reorder \n"
209	:
210	: "r"(size),"r"(src),"r"(dst)
211	: "$10","$11","$12","$13","$14","$15" );
212
213	hal_restore_irq( save_sr );
214
215	} // hal_strcpy_to_uspace()
216
217	///////////////////////////////////////////////
218	uint32_t hal_strlen_from_uspace( char * u_str )
219	{
220	uint32_t save_sr;
221	uint32_t count = 0;
222	uint32_t str = (uint32_t)u_str;
223
224	hal_disable_irq( &save_sr );
225
226	asm volatile(
227	".set noreorder \n"
228	"move $13, %1 \n" /* $13 <= str */
229	"mfc2 $15, $1 \n" /* $15 <= DTLB and ITLB off */
230	"ori $14, $15, 0x4 \n" /* $14 <= mode DTLB on */
231	"1: \n"
232	"mtc2 $14, $1 \n" /* set DTLB on */
233	"lb $12, 0($13) \n" /* read char from user space */
234	"mtc2 $15, $1 \n" /* set DTLB off */
235	"addi $13, $13, 1 \n" /* increment address */
236	"bne $12, $0, 1b \n" /* loop until NUL found */
237	"addi %0, %0, 1 \n" /* increment count */
238	".set reorder \n"
239	: "+r"(count)
240	: "r"(str)
241	: "$12","$13","$14","$15" );
242
243	hal_restore_irq( save_sr );
244
245	return count;
246	}
247

Note: See TracBrowser for help on using the repository browser.

Download in other formats: