[linux-2.6-block.git] / arch / mn10300 / mm / tlb-mn10300.S

###############################################################################
#
# TLB loading functions
#
# Copyright (C) 2007 Matsushita Electric Industrial Co., Ltd.
# Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
# Modified by David Howells (dhowells@redhat.com)
#
# This program is free software; you can redistribute it and/or
# modify it under the terms of the GNU General Public Licence
# as published by the Free Software Foundation; either version
# 2 of the Licence, or (at your option) any later version.
#
###############################################################################
#include <linux/sys.h>
#include <linux/linkage.h>
#include <asm/smp.h>
#include <asm/intctl-regs.h>
#include <asm/frame.inc>
#include <asm/page.h>
#include <asm/pgtable.h>

###############################################################################
#
# Instruction TLB Miss handler entry point
#
###############################################################################
	.type	itlb_miss,@function
ENTRY(itlb_miss)
	and	~EPSW_NMID,epsw
#ifdef CONFIG_GDBSTUB
	movm	[d2,d3,a2],(sp)
#else
	or	EPSW_nAR,epsw		# switch D0-D3 & A0-A3 to the alternate
					# register bank
	nop
	nop
	nop
#endif

	mov	(IPTEU),d3
	mov	(PTBR),a2
	mov	d3,d2
	and	0xffc00000,d2
	lsr	20,d2
	mov	(a2,d2),a2		# PTD *ptd = PGD[addr 31..22]
	btst	_PAGE_VALID,a2
	beq	itlb_miss_fault		# jump if doesn't point anywhere

	and	~(PAGE_SIZE-1),a2
	mov	d3,d2
	and	0x003ff000,d2
	lsr	10,d2
	add	d2,a2
	mov	(a2),d2			# get pte from PTD[addr 21..12]
	btst	_PAGE_VALID,d2
	beq	itlb_miss_fault		# jump if doesn't point to a page
					# (might be a swap id)
	bset	_PAGE_ACCESSED,(0,a2)
	and	~(xPTEL_UNUSED1|xPTEL_UNUSED2),d2
itlb_miss_set:
	mov	d2,(IPTEL)		# change the TLB
#ifdef CONFIG_GDBSTUB
	movm	(sp),[d2,d3,a2]
#endif
	rti

itlb_miss_fault:
	mov	_PAGE_VALID,d2		# force address error handler to be
					# invoked
	bra	itlb_miss_set

	.size	itlb_miss, . - itlb_miss

###############################################################################
#
# Data TLB Miss handler entry point
#
###############################################################################
	.type	dtlb_miss,@function
ENTRY(dtlb_miss)
	and	~EPSW_NMID,epsw
#ifdef CONFIG_GDBSTUB
	movm	[d2,d3,a2],(sp)
#else
	or	EPSW_nAR,epsw		# switch D0-D3 & A0-A3 to the alternate
					# register bank
	nop
	nop
	nop
#endif

	mov	(DPTEU),d3
	mov	(PTBR),a2
	mov	d3,d2
	and	0xffc00000,d2
	lsr	20,d2
	mov	(a2,d2),a2		# PTD *ptd = PGD[addr 31..22]
	btst	_PAGE_VALID,a2
	beq	dtlb_miss_fault		# jump if doesn't point anywhere

	and	~(PAGE_SIZE-1),a2
	mov	d3,d2
	and	0x003ff000,d2
	lsr	10,d2
	add	d2,a2
	mov	(a2),d2			# get pte from PTD[addr 21..12]
	btst	_PAGE_VALID,d2
	beq	dtlb_miss_fault		# jump if doesn't point to a page
					# (might be a swap id)
	bset	_PAGE_ACCESSED,(0,a2)
	and	~(xPTEL_UNUSED1|xPTEL_UNUSED2),d2
dtlb_miss_set:
	mov	d2,(DPTEL)		# change the TLB
#ifdef CONFIG_GDBSTUB
	movm	(sp),[d2,d3,a2]
#endif
	rti

dtlb_miss_fault:
	mov	_PAGE_VALID,d2		# force address error handler to be
					# invoked
	bra	dtlb_miss_set
	.size	dtlb_miss, . - dtlb_miss

###############################################################################
#
# Instruction TLB Address Error handler entry point
#
###############################################################################
	.type	itlb_aerror,@function
ENTRY(itlb_aerror)
	and	~EPSW_NMID,epsw
	add	-4,sp
	SAVE_ALL
	add	-4,sp				# need to pass three params

	# calculate the fault code
	movhu	(MMUFCR_IFC),d1
	or	0x00010000,d1			# it's an instruction fetch

	# determine the page address
	mov	(IPTEU),a2
	mov	a2,d0
	and	PAGE_MASK,d0
	mov	d0,(12,sp)

	clr	d0
	mov	d0,(IPTEL)

	and	~EPSW_NMID,epsw
	or	EPSW_IE,epsw
	mov	fp,d0
	call	do_page_fault[],0		# do_page_fault(regs,code,addr

	jmp	ret_from_exception
	.size	itlb_aerror, . - itlb_aerror

###############################################################################
#
# Data TLB Address Error handler entry point
#
###############################################################################
	.type	dtlb_aerror,@function
ENTRY(dtlb_aerror)
	and	~EPSW_NMID,epsw
	add	-4,sp
	SAVE_ALL
	add	-4,sp				# need to pass three params

	# calculate the fault code
	movhu	(MMUFCR_DFC),d1

	# determine the page address
	mov	(DPTEU),a2
	mov	a2,d0
	and	PAGE_MASK,d0
	mov	d0,(12,sp)

	clr	d0
	mov	d0,(DPTEL)

	and	~EPSW_NMID,epsw
	or	EPSW_IE,epsw
	mov	fp,d0
	call	do_page_fault[],0		# do_page_fault(regs,code,addr

	jmp	ret_from_exception
	.size	dtlb_aerror, . - dtlb_aerror
Commit	Line	Data
b920de1b DH	1	###############################################################################
	2	#
	3	# TLB loading functions
	4	#
	5	# Copyright (C) 2007 Matsushita Electric Industrial Co., Ltd.
	6	# Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
	7	# Modified by David Howells (dhowells@redhat.com)
	8	#
	9	# This program is free software; you can redistribute it and/or
	10	# modify it under the terms of the GNU General Public Licence
	11	# as published by the Free Software Foundation; either version
	12	# 2 of the Licence, or (at your option) any later version.
	13	#
	14	###############################################################################
	15	#include <linux/sys.h>
	16	#include <linux/linkage.h>
	17	#include <asm/smp.h>
	18	#include <asm/intctl-regs.h>
	19	#include <asm/frame.inc>
	20	#include <asm/page.h>
	21	#include <asm/pgtable.h>
	22
	23	###############################################################################
	24	#
	25	# Instruction TLB Miss handler entry point
	26	#
	27	###############################################################################
	28	.type itlb_miss,@function
	29	ENTRY(itlb_miss)
	30	and ~EPSW_NMID,epsw
	31	#ifdef CONFIG_GDBSTUB
	32	movm [d2,d3,a2],(sp)
	33	#else
	34	or EPSW_nAR,epsw # switch D0-D3 & A0-A3 to the alternate
	35	# register bank
	36	nop
	37	nop
	38	nop
	39	#endif
	40
	41	mov (IPTEU),d3
	42	mov (PTBR),a2
	43	mov d3,d2
	44	and 0xffc00000,d2
	45	lsr 20,d2
	46	mov (a2,d2),a2 # PTD *ptd = PGD[addr 31..22]
	47	btst _PAGE_VALID,a2
	48	beq itlb_miss_fault # jump if doesn't point anywhere
	49
	50	and ~(PAGE_SIZE-1),a2
	51	mov d3,d2
	52	and 0x003ff000,d2
	53	lsr 10,d2
	54	add d2,a2
	55	mov (a2),d2 # get pte from PTD[addr 21..12]
	56	btst _PAGE_VALID,d2
	57	beq itlb_miss_fault # jump if doesn't point to a page
	58	# (might be a swap id)
	59	bset _PAGE_ACCESSED,(0,a2)
	60	and ~(xPTEL_UNUSED1\|xPTEL_UNUSED2),d2
	61	itlb_miss_set:
	62	mov d2,(IPTEL) # change the TLB
	63	#ifdef CONFIG_GDBSTUB
	64	movm (sp),[d2,d3,a2]
65	#endif
66	rti
67
68	itlb_miss_fault:
69	mov _PAGE_VALID,d2 # force address error handler to be
70	# invoked
71	bra itlb_miss_set
72
73	.size itlb_miss, . - itlb_miss
74
75	###############################################################################
76	#
77	# Data TLB Miss handler entry point
78	#
79	###############################################################################
80	.type dtlb_miss,@function
81	ENTRY(dtlb_miss)
82	and ~EPSW_NMID,epsw
83	#ifdef CONFIG_GDBSTUB
84	movm [d2,d3,a2],(sp)
85	#else
86	or EPSW_nAR,epsw # switch D0-D3 & A0-A3 to the alternate
87	# register bank
88	nop
89	nop
90	nop
91	#endif
92
93	mov (DPTEU),d3
94	mov (PTBR),a2
95	mov d3,d2
96	and 0xffc00000,d2
97	lsr 20,d2
98	mov (a2,d2),a2 # PTD *ptd = PGD[addr 31..22]
99	btst _PAGE_VALID,a2
100	beq dtlb_miss_fault # jump if doesn't point anywhere
101
102	and ~(PAGE_SIZE-1),a2
103	mov d3,d2
104	and 0x003ff000,d2
105	lsr 10,d2
106	add d2,a2
107	mov (a2),d2 # get pte from PTD[addr 21..12]
108	btst _PAGE_VALID,d2
109	beq dtlb_miss_fault # jump if doesn't point to a page
110	# (might be a swap id)
111	bset _PAGE_ACCESSED,(0,a2)
112	and ~(xPTEL_UNUSED1\|xPTEL_UNUSED2),d2
113	dtlb_miss_set:
114	mov d2,(DPTEL) # change the TLB
115	#ifdef CONFIG_GDBSTUB
116	movm (sp),[d2,d3,a2]
117	#endif
118	rti
119
120	dtlb_miss_fault:
121	mov _PAGE_VALID,d2 # force address error handler to be
122	# invoked
123	bra dtlb_miss_set
124	.size dtlb_miss, . - dtlb_miss
125
126	###############################################################################
127	#
128	# Instruction TLB Address Error handler entry point
129	#
130	###############################################################################
131	.type itlb_aerror,@function
132	ENTRY(itlb_aerror)
133	and ~EPSW_NMID,epsw
134	add -4,sp
135	SAVE_ALL
136	add -4,sp # need to pass three params
137
138	# calculate the fault code
139	movhu (MMUFCR_IFC),d1
140	or 0x00010000,d1 # it's an instruction fetch
141
142	# determine the page address
143	mov (IPTEU),a2
144	mov a2,d0
145	and PAGE_MASK,d0
146	mov d0,(12,sp)
147
148	clr d0
149	mov d0,(IPTEL)
150
151	and ~EPSW_NMID,epsw
152	or EPSW_IE,epsw
153	mov fp,d0
154	call do_page_fault[],0 # do_page_fault(regs,code,addr
155
156	jmp ret_from_exception
157	.size itlb_aerror, . - itlb_aerror
158
159	###############################################################################
160	#
161	# Data TLB Address Error handler entry point
162	#
163	###############################################################################
164	.type dtlb_aerror,@function
165	ENTRY(dtlb_aerror)
166	and ~EPSW_NMID,epsw
167	add -4,sp
b920de1b DH	168	SAVE_ALL
	169	add -4,sp # need to pass three params
	170
	171	# calculate the fault code
	172	movhu (MMUFCR_DFC),d1
	173
	174	# determine the page address
	175	mov (DPTEU),a2
	176	mov a2,d0
	177	and PAGE_MASK,d0
	178	mov d0,(12,sp)
	179
	180	clr d0
	181	mov d0,(DPTEL)
	182
	183	and ~EPSW_NMID,epsw
	184	or EPSW_IE,epsw
	185	mov fp,d0
	186	call do_page_fault[],0 # do_page_fault(regs,code,addr
	187
	188	jmp ret_from_exception
	189	.size dtlb_aerror, . - dtlb_aerror