WebSVN – HelenOS-historic – Diff – /kernel/trunk/arch/ppc32/include/asm.h


/*
 * Copyright (C) 2005 Martin Decky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
#ifndef __ppc_ASM_H__
#define __ppc_ASM_H__
 
#include <arch/types.h>
#include <config.h>
 
/** Set priority level low
 *
 * Enable interrupts and return previous
 * value of EE.
 */
static inline pri_t cpu_priority_low(void) {
    pri_t v;
    __asm__ volatile (
        "mfmsr %0\n"
        "mfmsr %%r31\n"
        "ori %%r31, %%r31, 1 << 15\n"
        "mtmsr %%r31\n"
        : "=r" (v)
        :
        : "%r31"
    );
    return v;
}
 
/** Set priority level high
 *
 * Disable interrupts and return previous
 * value of EE.
 */
static inline pri_t cpu_priority_high(void) {
    pri_t v;
    __asm__ volatile (
        "mfmsr %0\n"
        "mfmsr %%r31\n"
        "rlwinm %%r31, %%r31, 0, 17, 15\n"
        "mtmsr %%r31\n"
        : "=r" (v)
        :
        : "%r31"
    );
    return v;
}
 
/** Restore priority level
 *
 * Restore EE.
 */
static inline void cpu_priority_restore(pri_t pri) {
    __asm__ volatile (
        "mfmsr %%r31\n"
        "rlwimi  %0, %%r31, 0, 17, 15\n"
        "cmpw 0, %0, %%r31\n"
        "beq 0f\n"
        "mtmsr %0\n"
        "0:\n"
        : "=r" (pri)
        : "0" (pri)
        : "%r31"
    );
}
 
/** Return raw priority level
 *
 * Return EE.
 */
static inline pri_t cpu_priority_read(void) {
    pri_t v;
    __asm__ volatile (
        "mfmsr %0\n"
        : "=r" (v)
    );
    return v;
}
 
/* TODO: implement the real stuff */
static inline __address get_stack_base(void)
{
    return NULL;
}
 
void cpu_sleep(void);
void asm_delay_loop(__u32 t);
 
#endif
 

Rev 204	Rev 210
1	/*	1	/*
2	* Copyright (C) 2005 Martin Decky	2	* Copyright (C) 2005 Martin Decky
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	#ifndef __ppc_ASM_H__	29	#ifndef __ppc_ASM_H__
30	#define __ppc_ASM_H__	30	#define __ppc_ASM_H__
31		31
32	#include <arch/types.h>	32	#include <arch/types.h>
33	#include <config.h>	33	#include <config.h>
34		34
35	/** Set priority level low	35	/** Set priority level low
36	*	36	*
37	* Enable interrupts and return previous	37	* Enable interrupts and return previous
38	* value of EE.	38	* value of EE.
39	*/	39	*/
40	static inline pri_t cpu_priority_low(void) {	40	static inline pri_t cpu_priority_low(void) {
41	pri_t v;	41	pri_t v;
42	__asm__ volatile (	42	__asm__ volatile (
43	"mfmsr %0\n"	43	"mfmsr %0\n"
44	"mfmsr %%r31\n"	44	"mfmsr %%r31\n"
45	"ori %%r31, %%r31, 1 << 15\n"	45	"ori %%r31, %%r31, 1 << 15\n"
46	"mtmsr %%r31\n"	46	"mtmsr %%r31\n"
47	: "=r" (v)	47	: "=r" (v)
48	:	48	:
49	: "%r31"	49	: "%r31"
50	);	50	);
51	return v;	51	return v;
52	}	52	}
53		53
54	/** Set priority level high	54	/** Set priority level high
55	*	55	*
56	* Disable interrupts and return previous	56	* Disable interrupts and return previous
57	* value of EE.	57	* value of EE.
58	*/	58	*/
59	static inline pri_t cpu_priority_high(void) {	59	static inline pri_t cpu_priority_high(void) {
60	pri_t v;	60	pri_t v;
61	__asm__ volatile (	61	__asm__ volatile (
62	"mfmsr %0\n"	62	"mfmsr %0\n"
63	"mfmsr %%r31\n"	63	"mfmsr %%r31\n"
64	"rlwinm %%r31, %%r31, 0, 17, 15\n"	64	"rlwinm %%r31, %%r31, 0, 17, 15\n"
65	"mtmsr %%r31\n"	65	"mtmsr %%r31\n"
66	: "=r" (v)	66	: "=r" (v)
67	:	67	:
68	: "%r31"	68	: "%r31"
69	);	69	);
70	return v;	70	return v;
71	}	71	}
72		72
73	/** Restore priority level	73	/** Restore priority level
74	*	74	*
75	* Restore EE.	75	* Restore EE.
76	*/	76	*/
77	static inline void cpu_priority_restore(pri_t pri) {	77	static inline void cpu_priority_restore(pri_t pri) {
78	__asm__ volatile (	78	__asm__ volatile (
79	"mfmsr %%r31\n"	79	"mfmsr %%r31\n"
80	"rlwimi %0, %%r31, 0, 17, 15\n"	80	"rlwimi %0, %%r31, 0, 17, 15\n"
-		81	"cmpw 0, %0, %%r31\n"
-		82	"beq 0f\n"
81	"mtmsr %0\n"	83	"mtmsr %0\n"
-		84	"0:\n"
82	: "=r" (pri)	85	: "=r" (pri)
83	: "0" (pri)	86	: "0" (pri)
84	: "%r31"	87	: "%r31"
85	);	88	);
86	}	89	}
-		90
-		91	/** Return raw priority level
-		92	*
-		93	* Return EE.
-		94	*/
-		95	static inline pri_t cpu_priority_read(void) {
-		96	pri_t v;
-		97	__asm__ volatile (
-		98	"mfmsr %0\n"
-		99	: "=r" (v)
-		100	);
-		101	return v;
-		102	}
87		103
88	/* TODO: implement the real stuff */	104	/* TODO: implement the real stuff */
89	static inline __address get_stack_base(void)	105	static inline __address get_stack_base(void)
90	{	106	{
91	return NULL;	107	return NULL;
92	}	108	}
93		109
94	void cpu_sleep(void);	110	void cpu_sleep(void);
95	void asm_delay_loop(__u32 t);	111	void asm_delay_loop(__u32 t);
96		112
97	#endif	113	#endif
98		114

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/ppc32/include/asm.h @ 1780 – Rev 204 → 210