Linux Audio

Check our new training course

Loading...
v6.13.7
   1/* SPDX-License-Identifier: GPL-2.0-or-later */
   2/*
   3 * Linux/PA-RISC Project (http://www.parisc-linux.org/)
   4 *
   5 * kernel entry points (interruptions, system call wrappers)
   6 *  Copyright (C) 1999,2000 Philipp Rumpf 
   7 *  Copyright (C) 1999 SuSE GmbH Nuernberg 
   8 *  Copyright (C) 2000 Hewlett-Packard (John Marvin)
   9 *  Copyright (C) 1999 Hewlett-Packard (Frank Rowand)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  10 */
  11
  12#include <asm/asm-offsets.h>
  13
  14/* we have the following possibilities to act on an interruption:
  15 *  - handle in assembly and use shadowed registers only
  16 *  - save registers to kernel stack and handle in assembly or C */
  17
  18
  19#include <asm/psw.h>
  20#include <asm/cache.h>		/* for L1_CACHE_SHIFT */
  21#include <asm/assembly.h>	/* for LDREG/STREG defines */
 
  22#include <asm/signal.h>
  23#include <asm/unistd.h>
  24#include <asm/ldcw.h>
  25#include <asm/traps.h>
  26#include <asm/thread_info.h>
  27#include <asm/alternative.h>
  28#include <asm/spinlock_types.h>
  29
  30#include <linux/linkage.h>
  31#include <linux/pgtable.h>
  32
  33#ifdef CONFIG_64BIT
  34	.level 2.0w
  35#else
  36	.level 2.0
  37#endif
  38
  39/*
  40 * We need seven instructions after a TLB insert for it to take effect.
  41 * The PA8800/PA8900 processors are an exception and need 12 instructions.
  42 * The RFI changes both IAOQ_Back and IAOQ_Front, so it counts as one.
  43 */
  44#ifdef CONFIG_64BIT
  45#define NUM_PIPELINE_INSNS    12
  46#else
  47#define NUM_PIPELINE_INSNS    7
  48#endif
  49
  50	/* Insert num nops */
  51	.macro	insert_nops num
  52	.rept \num
  53	nop
  54	.endr
  55	.endm
  56
  57	/* Get aligned page_table_lock address for this mm from cr28/tr4 */
  58	.macro  get_ptl reg
  59	mfctl	%cr28,\reg
  60	.endm
  61
  62	/* space_to_prot macro creates a prot id from a space id */
  63
  64#if (SPACEID_SHIFT) == 0
  65	.macro  space_to_prot spc prot
  66	depd,z  \spc,62,31,\prot
  67	.endm
  68#else
  69	.macro  space_to_prot spc prot
  70	extrd,u \spc,(64 - (SPACEID_SHIFT)),32,\prot
  71	.endm
  72#endif
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  73	/*
  74	 * The "get_stack" macros are responsible for determining the
  75	 * kernel stack value.
  76	 *
  77	 *      If sr7 == 0
  78	 *          Already using a kernel stack, so call the
  79	 *          get_stack_use_r30 macro to push a pt_regs structure
  80	 *          on the stack, and store registers there.
  81	 *      else
  82	 *          Need to set up a kernel stack, so call the
  83	 *          get_stack_use_cr30 macro to set up a pointer
  84	 *          to the pt_regs structure contained within the
  85	 *          task pointer pointed to by cr30. Load the stack
  86	 *          pointer from the task structure.
  87	 *
  88	 * Note that we use shadowed registers for temps until
  89	 * we can save %r26 and %r29. %r26 is used to preserve
  90	 * %r8 (a shadowed register) which temporarily contained
  91	 * either the fault type ("code") or the eirr. We need
  92	 * to use a non-shadowed register to carry the value over
  93	 * the rfir in virt_map. We use %r26 since this value winds
  94	 * up being passed as the argument to either do_cpu_irq_mask
  95	 * or handle_interruption. %r29 is used to hold a pointer
  96	 * the register save area, and once again, it needs to
  97	 * be a non-shadowed register so that it survives the rfir.
 
 
  98	 */
  99
 100	.macro  get_stack_use_cr30
 101
 102	/* we save the registers in the task struct */
 103
 104	copy	%r30, %r17
 105	mfctl   %cr30, %r1
 106	tophys  %r1,%r9		/* task_struct */
 107	LDREG	TASK_STACK(%r9),%r30
 108	ldo	PT_SZ_ALGN(%r30),%r30
 109	mtsp	%r0,%sr7	/* clear sr7 after kernel stack was set! */
 110	mtsp	%r16,%sr3
 111	ldo     TASK_REGS(%r9),%r9
 112	STREG   %r17,PT_GR30(%r9)
 113	STREG   %r29,PT_GR29(%r9)
 114	STREG   %r26,PT_GR26(%r9)
 115	STREG	%r16,PT_SR7(%r9)
 116	copy    %r9,%r29
 
 
 117	.endm
 118
 119	.macro  get_stack_use_r30
 120
 121	/* we put a struct pt_regs on the stack and save the registers there */
 122
 123	tophys  %r30,%r9
 124	copy	%r30,%r1
 125	ldo	PT_SZ_ALGN(%r30),%r30
 126	STREG   %r1,PT_GR30(%r9)
 127	STREG   %r29,PT_GR29(%r9)
 128	STREG   %r26,PT_GR26(%r9)
 129	STREG	%r16,PT_SR7(%r9)
 130	copy    %r9,%r29
 131	.endm
 132
 133	.macro  rest_stack
 134	LDREG   PT_GR1(%r29), %r1
 135	LDREG   PT_GR30(%r29),%r30
 136	LDREG   PT_GR29(%r29),%r29
 137	.endm
 138
 139	/* default interruption handler
 140	 * (calls traps.c:handle_interruption) */
 141	.macro	def code
 142	b	intr_save
 143	ldi     \code, %r8
 144	.align	32
 145	.endm
 146
 147	/* Interrupt interruption handler
 148	 * (calls irq.c:do_cpu_irq_mask) */
 149	.macro	extint code
 150	b	intr_extint
 151	mfsp    %sr7,%r16
 152	.align	32
 153	.endm	
 154
 155	.import	os_hpmc, code
 156
 157	/* HPMC handler */
 158	.macro	hpmc code
 159	nop			/* must be a NOP, will be patched later */
 160	load32	PA(os_hpmc), %r3
 161	bv,n	0(%r3)
 162	nop
 163	.word	0		/* checksum (will be patched) */
 164	.word	0		/* address of handler */
 165	.word	0		/* length of handler */
 166	.endm
 167
 168	/*
 169	 * Performance Note: Instructions will be moved up into
 170	 * this part of the code later on, once we are sure
 171	 * that the tlb miss handlers are close to final form.
 172	 */
 173
 174	/* Register definitions for tlb miss handler macros */
 175
 176	va  = r8	/* virtual address for which the trap occurred */
 177	spc = r24	/* space for which the trap occurred */
 178
 179#ifndef CONFIG_64BIT
 180
 181	/*
 182	 * itlb miss interruption handler (parisc 1.1 - 32 bit)
 183	 */
 184
 185	.macro	itlb_11 code
 186
 187	mfctl	%pcsq, spc
 188	b	itlb_miss_11
 189	mfctl	%pcoq, va
 190
 191	.align		32
 192	.endm
 193#endif
 194	
 195	/*
 196	 * itlb miss interruption handler (parisc 2.0)
 197	 */
 198
 199	.macro	itlb_20 code
 200	mfctl	%pcsq, spc
 201#ifdef CONFIG_64BIT
 202	b       itlb_miss_20w
 203#else
 204	b	itlb_miss_20
 205#endif
 206	mfctl	%pcoq, va
 207
 208	.align		32
 209	.endm
 210	
 211#ifndef CONFIG_64BIT
 212	/*
 213	 * naitlb miss interruption handler (parisc 1.1 - 32 bit)
 214	 */
 215
 216	.macro	naitlb_11 code
 217
 218	mfctl	%isr,spc
 219	b	naitlb_miss_11
 220	mfctl 	%ior,va
 221
 222	.align		32
 223	.endm
 224#endif
 225	
 226	/*
 227	 * naitlb miss interruption handler (parisc 2.0)
 228	 */
 229
 230	.macro	naitlb_20 code
 231
 232	mfctl	%isr,spc
 233#ifdef CONFIG_64BIT
 234	b       naitlb_miss_20w
 235#else
 236	b	naitlb_miss_20
 237#endif
 238	mfctl 	%ior,va
 239
 240	.align		32
 241	.endm
 242	
 243#ifndef CONFIG_64BIT
 244	/*
 245	 * dtlb miss interruption handler (parisc 1.1 - 32 bit)
 246	 */
 247
 248	.macro	dtlb_11 code
 249
 250	mfctl	%isr, spc
 251	b	dtlb_miss_11
 252	mfctl	%ior, va
 253
 254	.align		32
 255	.endm
 256#endif
 257
 258	/*
 259	 * dtlb miss interruption handler (parisc 2.0)
 260	 */
 261
 262	.macro	dtlb_20 code
 263
 264	mfctl	%isr, spc
 265#ifdef CONFIG_64BIT
 266	b       dtlb_miss_20w
 267#else
 268	b	dtlb_miss_20
 269#endif
 270	mfctl	%ior, va
 271
 272	.align		32
 273	.endm
 274	
 275#ifndef CONFIG_64BIT
 276	/* nadtlb miss interruption handler (parisc 1.1 - 32 bit) */
 277
 278	.macro	nadtlb_11 code
 279
 280	mfctl	%isr,spc
 281	b       nadtlb_miss_11
 282	mfctl	%ior,va
 283
 284	.align		32
 285	.endm
 286#endif
 287	
 288	/* nadtlb miss interruption handler (parisc 2.0) */
 289
 290	.macro	nadtlb_20 code
 291
 292	mfctl	%isr,spc
 293#ifdef CONFIG_64BIT
 294	b       nadtlb_miss_20w
 295#else
 296	b       nadtlb_miss_20
 297#endif
 298	mfctl	%ior,va
 299
 300	.align		32
 301	.endm
 302	
 303#ifndef CONFIG_64BIT
 304	/*
 305	 * dirty bit trap interruption handler (parisc 1.1 - 32 bit)
 306	 */
 307
 308	.macro	dbit_11 code
 309
 310	mfctl	%isr,spc
 311	b	dbit_trap_11
 312	mfctl	%ior,va
 313
 314	.align		32
 315	.endm
 316#endif
 317
 318	/*
 319	 * dirty bit trap interruption handler (parisc 2.0)
 320	 */
 321
 322	.macro	dbit_20 code
 323
 324	mfctl	%isr,spc
 325#ifdef CONFIG_64BIT
 326	b       dbit_trap_20w
 327#else
 328	b	dbit_trap_20
 329#endif
 330	mfctl	%ior,va
 331
 332	.align		32
 333	.endm
 334
 335	/* In LP64, the space contains part of the upper 32 bits of the
 336	 * fault.  We have to extract this and place it in the va,
 337	 * zeroing the corresponding bits in the space register */
 338	.macro		space_adjust	spc,va,tmp
 339#ifdef CONFIG_64BIT
 340	extrd,u		\spc,63,SPACEID_SHIFT,\tmp
 341	depd		%r0,63,SPACEID_SHIFT,\spc
 342	depd		\tmp,31,SPACEID_SHIFT,\va
 343#endif
 344	.endm
 345
 346	.import		swapper_pg_dir,code
 347
 348	/* Get the pgd.  For faults on space zero (kernel space), this
 349	 * is simply swapper_pg_dir.  For user space faults, the
 350	 * pgd is stored in %cr25 */
 351	.macro		get_pgd		spc,reg
 352	ldil		L%PA(swapper_pg_dir),\reg
 353	ldo		R%PA(swapper_pg_dir)(\reg),\reg
 354	or,COND(=)	%r0,\spc,%r0
 355	mfctl		%cr25,\reg
 356	.endm
 357
 358	/* 
 359		space_check(spc,tmp,fault)
 360
 361		spc - The space we saw the fault with.
 362		tmp - The place to store the current space.
 363		fault - Function to call on failure.
 364
 365		Only allow faults on different spaces from the
 366		currently active one if we're the kernel 
 367
 368	*/
 369	.macro		space_check	spc,tmp,fault
 370	mfsp		%sr7,\tmp
 371	/* check against %r0 which is same value as LINUX_GATEWAY_SPACE */
 372	or,COND(<>)	%r0,\spc,%r0	/* user may execute gateway page
 373					 * as kernel, so defeat the space
 374					 * check if it is */
 375	copy		\spc,\tmp
 376	or,COND(=)	%r0,\tmp,%r0	/* nullify if executing as kernel */
 377	cmpb,COND(<>),n	\tmp,\spc,\fault
 378	.endm
 379
 380	/* Look up a PTE in a 2-Level scheme (faulting at each
 381	 * level if the entry isn't present 
 382	 *
 383	 * NOTE: we use ldw even for LP64, since the short pointers
 384	 * can address up to 1TB
 385	 */
 386	.macro		L2_ptep	pmd,pte,index,va,fault
 387#if CONFIG_PGTABLE_LEVELS == 3
 388	extru_safe	\va,31-ASM_PMD_SHIFT,ASM_BITS_PER_PMD,\index
 389#else
 390	extru_safe	\va,31-ASM_PGDIR_SHIFT,ASM_BITS_PER_PGD,\index
 391#endif
 392	dep             %r0,31,PAGE_SHIFT,\pmd  /* clear offset */
 393#if CONFIG_PGTABLE_LEVELS < 3
 394	copy		%r0,\pte
 395#endif
 396	ldw,s		\index(\pmd),\pmd
 397	bb,>=,n		\pmd,_PxD_PRESENT_BIT,\fault
 398	dep		%r0,31,PxD_FLAG_SHIFT,\pmd /* clear flags */
 399	SHLREG		\pmd,PxD_VALUE_SHIFT,\pmd
 400	extru_safe	\va,31-PAGE_SHIFT,ASM_BITS_PER_PTE,\index
 
 401	dep		%r0,31,PAGE_SHIFT,\pmd  /* clear offset */
 402	shladd		\index,BITS_PER_PTE_ENTRY,\pmd,\pmd /* pmd is now pte */
 
 
 403	.endm
 404
 405	/* Look up PTE in a 3-Level scheme. */
 
 
 
 
 
 
 
 
 
 406	.macro		L3_ptep pgd,pte,index,va,fault
 407#if CONFIG_PGTABLE_LEVELS == 3
 408	copy		%r0,\pte
 409	extrd,u		\va,63-ASM_PGDIR_SHIFT,ASM_BITS_PER_PGD,\index
 
 
 410	ldw,s		\index(\pgd),\pgd
 
 411	bb,>=,n		\pgd,_PxD_PRESENT_BIT,\fault
 412	shld		\pgd,PxD_VALUE_SHIFT,\pgd
 
 
 
 
 
 413#endif
 414	L2_ptep		\pgd,\pte,\index,\va,\fault
 415	.endm
 416
 417	/* Acquire page_table_lock and check page is present. */
 418	.macro		ptl_lock	spc,ptp,pte,tmp,tmp1,fault
 419#ifdef CONFIG_TLB_PTLOCK
 42098:	cmpib,COND(=),n	0,\spc,2f
 421	get_ptl		\tmp
 4221:	LDCW		0(\tmp),\tmp1
 423	cmpib,COND(=)	0,\tmp1,1b
 424	nop
 425	LDREG		0(\ptp),\pte
 426	bb,<,n		\pte,_PAGE_PRESENT_BIT,3f
 427	b		\fault
 428	stw		\tmp1,0(\tmp)
 42999:	ALTERNATIVE(98b, 99b, ALT_COND_NO_SMP, INSN_NOP)
 430#endif
 4312:	LDREG		0(\ptp),\pte
 432	bb,>=,n		\pte,_PAGE_PRESENT_BIT,\fault
 4333:
 434	.endm
 435
 436	/* Release page_table_lock if for user space. We use an ordered
 437	   store to ensure all prior accesses are performed prior to
 438	   releasing the lock. Note stw may not be executed, so we
 439	   provide one extra nop when CONFIG_TLB_PTLOCK is defined. */
 440	.macro		ptl_unlock	spc,tmp,tmp2
 441#ifdef CONFIG_TLB_PTLOCK
 44298:	get_ptl		\tmp
 443	ldi		__ARCH_SPIN_LOCK_UNLOCKED_VAL, \tmp2
 444	or,COND(=)	%r0,\spc,%r0
 445	stw,ma		\tmp2,0(\tmp)
 44699:	ALTERNATIVE(98b, 99b, ALT_COND_NO_SMP, INSN_NOP)
 447	insert_nops	NUM_PIPELINE_INSNS - 4
 448#else
 449	insert_nops	NUM_PIPELINE_INSNS - 1
 450#endif
 451	.endm
 452
 453	/* Set the _PAGE_ACCESSED bit of the PTE.  Be clever and
 454	 * don't needlessly dirty the cache line if it was already set */
 455	.macro		update_accessed	ptp,pte,tmp,tmp1
 456	ldi		_PAGE_ACCESSED,\tmp1
 457	or		\tmp1,\pte,\tmp
 458	and,COND(<>)	\tmp1,\pte,%r0
 459	STREG		\tmp,0(\ptp)
 460	.endm
 461
 462	/* Set the dirty bit (and accessed bit).  No need to be
 463	 * clever, this is only used from the dirty fault */
 464	.macro		update_dirty	ptp,pte,tmp
 465	ldi		_PAGE_ACCESSED|_PAGE_DIRTY,\tmp
 466	or		\tmp,\pte,\pte
 467	STREG		\pte,0(\ptp)
 468	.endm
 469
 470	/* We have (depending on the page size):
 471	 * - 38 to 52-bit Physical Page Number
 472	 * - 12 to 26-bit page offset
 473	 */
 474	/* bitshift difference between a PFN (based on kernel's PAGE_SIZE)
 475	 * to a CPU TLB 4k PFN (4k => 12 bits to shift) */
 476	#define PAGE_ADD_SHIFT		(PAGE_SHIFT-12)
 477	#define PAGE_ADD_HUGE_SHIFT	(REAL_HPAGE_SHIFT-12)
 478	#define PFN_START_BIT	(63-ASM_PFN_PTE_SHIFT+(63-58)-PAGE_ADD_SHIFT)
 479
 480	/* Drop prot bits and convert to page addr for iitlbt and idtlbt */
 481	.macro		convert_for_tlb_insert20 pte,tmp
 482#ifdef CONFIG_HUGETLB_PAGE
 483	copy		\pte,\tmp
 484	extrd,u		\tmp,PFN_START_BIT,PFN_START_BIT+1,\pte
 485
 486	depdi		_PAGE_SIZE_ENCODING_DEFAULT,63,\
 487				(63-58)+PAGE_ADD_SHIFT,\pte
 488	extrd,u,*=	\tmp,_PAGE_HPAGE_BIT+32,1,%r0
 489	depdi		_HUGE_PAGE_SIZE_ENCODING_DEFAULT,63,\
 490				(63-58)+PAGE_ADD_HUGE_SHIFT,\pte
 491#else /* Huge pages disabled */
 492	extrd,u		\pte,PFN_START_BIT,PFN_START_BIT+1,\pte
 493	depdi		_PAGE_SIZE_ENCODING_DEFAULT,63,\
 494				(63-58)+PAGE_ADD_SHIFT,\pte
 495#endif
 496	.endm
 497
 498	/* Convert the pte and prot to tlb insertion values.  How
 499	 * this happens is quite subtle, read below */
 500	.macro		make_insert_tlb	spc,pte,prot,tmp
 501	space_to_prot   \spc \prot        /* create prot id from space */
 502	/* The following is the real subtlety.  This is depositing
 503	 * T <-> _PAGE_REFTRAP
 504	 * D <-> _PAGE_DIRTY
 505	 * B <-> _PAGE_DMB (memory break)
 506	 *
 507	 * Then incredible subtlety: The access rights are
 508	 * _PAGE_GATEWAY, _PAGE_EXEC and _PAGE_WRITE
 509	 * See 3-14 of the parisc 2.0 manual
 510	 *
 511	 * Finally, _PAGE_READ goes in the top bit of PL1 (so we
 512	 * trigger an access rights trap in user space if the user
 513	 * tries to read an unreadable page */
 514#if _PAGE_SPECIAL_BIT == _PAGE_DMB_BIT
 515	/* need to drop DMB bit, as it's used as SPECIAL flag */
 516	depi		0,_PAGE_SPECIAL_BIT,1,\pte
 517#endif
 518	depd            \pte,8,7,\prot
 519
 520	/* PAGE_USER indicates the page can be read with user privileges,
 521	 * so deposit X1|11 to PL1|PL2 (remember the upper bit of PL1
 522	 * contains _PAGE_READ) */
 523	extrd,u,*=      \pte,_PAGE_USER_BIT+32,1,%r0
 524	depdi		7,11,3,\prot
 525	/* If we're a gateway page, drop PL2 back to zero for promotion
 526	 * to kernel privilege (so we can execute the page as kernel).
 527	 * Any privilege promotion page always denys read and write */
 528	extrd,u,*= 	\pte,_PAGE_GATEWAY_BIT+32,1,%r0
 529	depd		%r0,11,2,\prot	/* If Gateway, Set PL2 to 0 */
 530
 531	/* Enforce uncacheable pages.
 532	 * This should ONLY be use for MMIO on PA 2.0 machines.
 533	 * Memory/DMA is cache coherent on all PA2.0 machines we support
 534	 * (that means T-class is NOT supported) and the memory controllers
 535	 * on most of those machines only handles cache transactions.
 536	 */
 537	extrd,u,*=	\pte,_PAGE_NO_CACHE_BIT+32,1,%r0
 538	depdi		1,12,1,\prot
 539
 540	/* Drop prot bits and convert to page addr for iitlbt and idtlbt */
 541	convert_for_tlb_insert20 \pte \tmp
 542	.endm
 543
 544	/* Identical macro to make_insert_tlb above, except it
 545	 * makes the tlb entry for the differently formatted pa11
 546	 * insertion instructions */
 547	.macro		make_insert_tlb_11	spc,pte,prot
 548#if _PAGE_SPECIAL_BIT == _PAGE_DMB_BIT
 549	/* need to drop DMB bit, as it's used as SPECIAL flag */
 550	depi		0,_PAGE_SPECIAL_BIT,1,\pte
 551#endif
 552	zdep		\spc,30,15,\prot
 553	dep		\pte,8,7,\prot
 554	extru,=		\pte,_PAGE_NO_CACHE_BIT,1,%r0
 555	depi		1,12,1,\prot
 556	extru,=         \pte,_PAGE_USER_BIT,1,%r0
 557	depi		7,11,3,\prot   /* Set for user space (1 rsvd for read) */
 558	extru,= 	\pte,_PAGE_GATEWAY_BIT,1,%r0
 559	depi		0,11,2,\prot	/* If Gateway, Set PL2 to 0 */
 560
 561	/* Get rid of prot bits and convert to page addr for iitlba */
 562
 563	depi		0,31,ASM_PFN_PTE_SHIFT,\pte
 564	SHRREG		\pte,(ASM_PFN_PTE_SHIFT-(31-26)),\pte
 565	.endm
 566
 567	/* This is for ILP32 PA2.0 only.  The TLB insertion needs
 568	 * to extend into I/O space if the address is 0xfXXXXXXX
 569	 * so we extend the f's into the top word of the pte in
 570	 * this case */
 571	.macro		f_extend	pte,tmp
 572	extrd,s		\pte,42,4,\tmp
 573	addi,<>		1,\tmp,%r0
 574	extrd,s		\pte,63,25,\pte
 575	.endm
 576
 577	/* The alias region is comprised of a pair of 4 MB regions
 578	 * aligned to 8 MB. It is used to clear/copy/flush user pages
 579	 * using kernel virtual addresses congruent with the user
 580	 * virtual address.
 581	 *
 582	 * To use the alias page, you set %r26 up with the to TLB
 583	 * entry (identifying the physical page) and %r23 up with
 584	 * the from tlb entry (or nothing if only a to entry---for
 585	 * clear_user_page_asm) */
 586	.macro		do_alias	spc,tmp,tmp1,va,pte,prot,fault,patype
 587	cmpib,COND(<>),n 0,\spc,\fault
 588	ldil		L%(TMPALIAS_MAP_START),\tmp
 
 
 
 
 
 589	copy		\va,\tmp1
 590	depi_safe	0,31,TMPALIAS_SIZE_BITS+1,\tmp1
 591	cmpb,COND(<>),n	\tmp,\tmp1,\fault
 592	mfctl		%cr19,\tmp	/* iir */
 593	/* get the opcode (first six bits) into \tmp */
 594	extrw,u		\tmp,5,6,\tmp
 595	/*
 596	 * Only setting the T bit prevents data cache movein
 597	 * Setting access rights to zero prevents instruction cache movein
 598	 *
 599	 * Note subtlety here: _PAGE_GATEWAY, _PAGE_EXEC and _PAGE_WRITE go
 600	 * to type field and _PAGE_READ goes to top bit of PL1
 601	 */
 602	ldi		(_PAGE_REFTRAP|_PAGE_READ|_PAGE_WRITE),\prot
 603	/*
 604	 * so if the opcode is one (i.e. this is a memory management
 605	 * instruction) nullify the next load so \prot is only T.
 606	 * Otherwise this is a normal data operation
 607	 */
 608	cmpiclr,=	0x01,\tmp,%r0
 609	ldi		(_PAGE_DIRTY|_PAGE_READ|_PAGE_WRITE),\prot
 610.ifc \patype,20
 611	depd,z		\prot,8,7,\prot
 612.else
 613.ifc \patype,11
 614	depw,z		\prot,8,7,\prot
 615.else
 616	.error "undefined PA type to do_alias"
 617.endif
 618.endif
 619	/*
 620	 * OK, it is in the temp alias region, check whether "from" or "to".
 621	 * Check "subtle" note in pacache.S re: r23/r26.
 622	 */
 623	extrw,u,=	\va,31-TMPALIAS_SIZE_BITS,1,%r0
 
 
 
 
 624	or,COND(tr)	%r23,%r0,\pte
 625	or		%r26,%r0,\pte
 626
 627	/* convert phys addr in \pte (from r23 or r26) to tlb insert format */
 628	SHRREG		\pte,PAGE_SHIFT+PAGE_ADD_SHIFT-5, \pte
 629	depi_safe	_PAGE_SIZE_ENCODING_DEFAULT, 31,5, \pte
 630	.endm 
 631
 632
 633	/*
 634	 * Fault_vectors are architecturally required to be aligned on a 2K
 635	 * boundary
 
 
 
 
 636	 */
 637
 638	.section .text.hot
 639	.align 2048
 
 640
 641ENTRY(fault_vector_20)
 642	/* First vector is invalid (0) */
 643	.ascii	"cows can fly"
 644	.byte 0
 645	.align 32
 646
 647	hpmc		 1
 648	def		 2
 649	def		 3
 650	extint		 4
 651	def		 5
 652	itlb_20		 PARISC_ITLB_TRAP
 653	def		 7
 654	def		 8
 655	def              9
 656	def		10
 657	def		11
 658	def		12
 659	def		13
 660	def		14
 661	dtlb_20		15
 662	naitlb_20	16
 663	nadtlb_20	17
 664	def		18
 665	def		19
 666	dbit_20		20
 667	def		21
 668	def		22
 669	def		23
 670	def		24
 671	def		25
 672	def		26
 673	def		27
 674	def		28
 675	def		29
 676	def		30
 677	def		31
 678END(fault_vector_20)
 679
 680#ifndef CONFIG_64BIT
 681
 682	.align 2048
 683
 684ENTRY(fault_vector_11)
 685	/* First vector is invalid (0) */
 686	.ascii	"cows can fly"
 687	.byte 0
 688	.align 32
 689
 690	hpmc		 1
 691	def		 2
 692	def		 3
 693	extint		 4
 694	def		 5
 695	itlb_11		 PARISC_ITLB_TRAP
 696	def		 7
 697	def		 8
 698	def              9
 699	def		10
 700	def		11
 701	def		12
 702	def		13
 703	def		14
 704	dtlb_11		15
 705	naitlb_11	16
 706	nadtlb_11	17
 707	def		18
 708	def		19
 709	dbit_11		20
 710	def		21
 711	def		22
 712	def		23
 713	def		24
 714	def		25
 715	def		26
 716	def		27
 717	def		28
 718	def		29
 719	def		30
 720	def		31
 721END(fault_vector_11)
 722
 723#endif
 724	/* Fault vector is separately protected and *must* be on its own page */
 725	.align		PAGE_SIZE
 
 726
 727	.import		handle_interruption,code
 728	.import		do_cpu_irq_mask,code
 729
 730	/*
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 731	 * Child Returns here
 732	 *
 733	 * copy_thread moved args into task save area.
 
 734	 */
 735
 736ENTRY(ret_from_kernel_thread)
 
 737	/* Call schedule_tail first though */
 738	BL	schedule_tail, %r2
 739	nop
 740
 741	mfctl	%cr30,%r1	/* task_struct */
 742	LDREG	TASK_PT_GR25(%r1), %r26
 743#ifdef CONFIG_64BIT
 744	LDREG	TASK_PT_GR27(%r1), %r27
 
 745#endif
 746	LDREG	TASK_PT_GR26(%r1), %r1
 747	ble	0(%sr7, %r1)
 748	copy	%r31, %r2
 749	b	finish_child_return
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 750	nop
 751END(ret_from_kernel_thread)
 752
 753
 754	/*
 755	 * struct task_struct *_switch_to(struct task_struct *prev,
 756	 *	struct task_struct *next)
 757	 *
 758	 * switch kernel stacks and return prev */
 759ENTRY_CFI(_switch_to)
 760	STREG	 %r2, -RP_OFFSET(%r30)
 761
 762	callee_save_float
 763	callee_save
 764
 765	load32	_switch_to_ret, %r2
 766
 767	STREG	%r2, TASK_PT_KPC(%r26)
 768	LDREG	TASK_PT_KPC(%r25), %r2
 769
 770	STREG	%r30, TASK_PT_KSP(%r26)
 771	LDREG	TASK_PT_KSP(%r25), %r30
 
 772	bv	%r0(%r2)
 773	mtctl   %r25,%cr30
 774
 775ENTRY(_switch_to_ret)
 776	mtctl	%r0, %cr0		/* Needed for single stepping */
 777	callee_rest
 778	callee_rest_float
 779
 780	LDREG	-RP_OFFSET(%r30), %r2
 781	bv	%r0(%r2)
 782	copy	%r26, %r28
 783ENDPROC_CFI(_switch_to)
 784
 785	/*
 786	 * Common rfi return path for interruptions, kernel execve, and
 787	 * sys_rt_sigreturn (sometimes).  The sys_rt_sigreturn syscall will
 788	 * return via this path if the signal was received when the process
 789	 * was running; if the process was blocked on a syscall then the
 790	 * normal syscall_exit path is used.  All syscalls for traced
 791	 * proceses exit via intr_restore.
 792	 *
 793	 * XXX If any syscalls that change a processes space id ever exit
 794	 * this way, then we will need to copy %sr3 in to PT_SR[3..7], and
 795	 * adjust IASQ[0..1].
 796	 *
 797	 */
 798
 799	.align	PAGE_SIZE
 800
 801ENTRY_CFI(syscall_exit_rfi)
 802	mfctl	%cr30,%r16		/* task_struct */
 
 803	ldo	TASK_REGS(%r16),%r16
 804	/* Force iaoq to userspace, as the user has had access to our current
 805	 * context via sigcontext. Also Filter the PSW for the same reason.
 806	 */
 807	LDREG	PT_IAOQ0(%r16),%r19
 808	depi	PRIV_USER,31,2,%r19
 809	STREG	%r19,PT_IAOQ0(%r16)
 810	LDREG	PT_IAOQ1(%r16),%r19
 811	depi	PRIV_USER,31,2,%r19
 812	STREG	%r19,PT_IAOQ1(%r16)
 813	LDREG   PT_PSW(%r16),%r19
 814	load32	USER_PSW_MASK,%r1
 815#ifdef CONFIG_64BIT
 816	load32	USER_PSW_HI_MASK,%r20
 817	depd    %r20,31,32,%r1
 818#endif
 819	and     %r19,%r1,%r19 /* Mask out bits that user shouldn't play with */
 820	load32	USER_PSW,%r1
 821	or      %r19,%r1,%r19 /* Make sure default USER_PSW bits are set */
 822	STREG   %r19,PT_PSW(%r16)
 823
 824	/*
 825	 * If we aren't being traced, we never saved space registers
 826	 * (we don't store them in the sigcontext), so set them
 827	 * to "proper" values now (otherwise we'll wind up restoring
 828	 * whatever was last stored in the task structure, which might
 829	 * be inconsistent if an interrupt occurred while on the gateway
 830	 * page). Note that we may be "trashing" values the user put in
 831	 * them, but we don't support the user changing them.
 832	 */
 833
 834	STREG   %r0,PT_SR2(%r16)
 835	mfsp    %sr3,%r19
 836	STREG   %r19,PT_SR0(%r16)
 837	STREG   %r19,PT_SR1(%r16)
 838	STREG   %r19,PT_SR3(%r16)
 839	STREG   %r19,PT_SR4(%r16)
 840	STREG   %r19,PT_SR5(%r16)
 841	STREG   %r19,PT_SR6(%r16)
 842	STREG   %r19,PT_SR7(%r16)
 843
 844ENTRY(intr_return)
 
 
 
 
 
 845	/* check for reschedule */
 846	mfctl   %cr30,%r1
 847	LDREG   TASK_TI_FLAGS(%r1),%r19	/* sched.h: TIF_NEED_RESCHED */
 848	bb,<,n	%r19,31-TIF_NEED_RESCHED,intr_do_resched /* forward */
 849
 850	.import do_notify_resume,code
 851intr_check_sig:
 852	/* As above */
 853	mfctl   %cr30,%r1
 854	LDREG	TASK_TI_FLAGS(%r1),%r19
 855	ldi	(_TIF_USER_WORK_MASK & ~_TIF_NEED_RESCHED), %r20
 856	and,COND(<>)	%r19, %r20, %r0
 857	b,n	intr_restore	/* skip past if we've nothing to do */
 858
 859	/* This check is critical to having LWS
 860	 * working. The IASQ is zero on the gateway
 861	 * page and we cannot deliver any signals until
 862	 * we get off the gateway page.
 863	 *
 864	 * Only do signals if we are returning to user space
 865	 */
 866	LDREG	PT_IASQ0(%r16), %r20
 867	cmpib,COND(=),n LINUX_GATEWAY_SPACE, %r20, intr_restore /* forward */
 868	LDREG	PT_IASQ1(%r16), %r20
 869	cmpib,COND(=),n LINUX_GATEWAY_SPACE, %r20, intr_restore /* forward */
 870
 871	copy	%r0, %r25			/* long in_syscall = 0 */
 872#ifdef CONFIG_64BIT
 873	ldo	-16(%r30),%r29			/* Reference param save area */
 874#endif
 875
 876	/* NOTE: We need to enable interrupts if we have to deliver
 877	 * signals. We used to do this earlier but it caused kernel
 878	 * stack overflows. */
 879	ssm	PSW_SM_I, %r0
 880
 881	BL	do_notify_resume,%r2
 882	copy	%r16, %r26			/* struct pt_regs *regs */
 883
 884	b,n	intr_check_sig
 885
 886intr_restore:
 887	copy            %r16,%r29
 888	ldo             PT_FR31(%r29),%r1
 889	rest_fp         %r1
 890	rest_general    %r29
 891
 892	/* inverse of virt_map */
 893	pcxt_ssm_bug
 894	rsm             PSW_SM_QUIET,%r0	/* prepare for rfi */
 895	tophys_r1       %r29
 896
 897	/* Restore space id's and special cr's from PT_REGS
 898	 * structure pointed to by r29
 899	 */
 900	rest_specials	%r29
 901
 902	/* IMPORTANT: rest_stack restores r29 last (we are using it)!
 903	 * It also restores r1 and r30.
 904	 */
 905	rest_stack
 906
 907	rfi
 908	nop
 909
 910#ifndef CONFIG_PREEMPTION
 911# define intr_do_preempt	intr_restore
 912#endif /* !CONFIG_PREEMPTION */
 913
 914	.import schedule,code
 915intr_do_resched:
 916	/* Only call schedule on return to userspace. If we're returning
 917	 * to kernel space, we may schedule if CONFIG_PREEMPTION, otherwise
 918	 * we jump back to intr_restore.
 919	 */
 920	LDREG	PT_IASQ0(%r16), %r20
 921	cmpib,COND(=)	0, %r20, intr_do_preempt
 922	nop
 923	LDREG	PT_IASQ1(%r16), %r20
 924	cmpib,COND(=)	0, %r20, intr_do_preempt
 925	nop
 926
 927	/* NOTE: We need to enable interrupts if we schedule.  We used
 928	 * to do this earlier but it caused kernel stack overflows. */
 929	ssm     PSW_SM_I, %r0
 930
 931#ifdef CONFIG_64BIT
 932	ldo	-16(%r30),%r29		/* Reference param save area */
 933#endif
 934
 935	ldil	L%intr_check_sig, %r2
 936#ifndef CONFIG_64BIT
 937	b	schedule
 938#else
 939	load32	schedule, %r20
 940	bv	%r0(%r20)
 941#endif
 942	ldo	R%intr_check_sig(%r2), %r2
 943
 944	/* preempt the current task on returning to kernel
 945	 * mode from an interrupt, iff need_resched is set,
 946	 * and preempt_count is 0. otherwise, we continue on
 947	 * our merry way back to the current running task.
 948	 */
 949#ifdef CONFIG_PREEMPTION
 950	.import preempt_schedule_irq,code
 951intr_do_preempt:
 952	rsm	PSW_SM_I, %r0		/* disable interrupts */
 953
 954	/* current_thread_info()->preempt_count */
 955	mfctl	%cr30, %r1
 956	ldw	TI_PRE_COUNT(%r1), %r19
 957	cmpib,<>	0, %r19, intr_restore	/* if preempt_count > 0 */
 958	nop				/* prev insn branched backwards */
 959
 960	/* check if we interrupted a critical path */
 961	LDREG	PT_PSW(%r16), %r20
 962	bb,<,n	%r20, 31 - PSW_SM_I, intr_restore
 963	nop
 964
 965	/* ssm PSW_SM_I done later in intr_restore */
 966#ifdef CONFIG_MLONGCALLS
 967	ldil	L%intr_restore, %r2
 968	load32	preempt_schedule_irq, %r1
 969	bv	%r0(%r1)
 970	ldo	R%intr_restore(%r2), %r2
 971#else
 972	ldil	L%intr_restore, %r1
 973	BL	preempt_schedule_irq, %r2
 974	ldo	R%intr_restore(%r1), %r2
 975#endif
 976#endif /* CONFIG_PREEMPTION */
 
 977
 978	/*
 979	 * External interrupts.
 980	 */
 981
 982intr_extint:
 983	cmpib,COND(=),n 0,%r16,1f
 984
 985	get_stack_use_cr30
 986	b,n 2f
 987
 9881:
 989	get_stack_use_r30
 9902:
 991	save_specials	%r29
 992	virt_map
 993	save_general	%r29
 994
 995	ldo	PT_FR0(%r29), %r24
 996	save_fp	%r24
 997	
 998	loadgp
 999
1000	copy	%r29, %r26	/* arg0 is pt_regs */
1001	copy	%r29, %r16	/* save pt_regs */
1002
1003	ldil	L%intr_return, %r2
1004
1005#ifdef CONFIG_64BIT
1006	ldo	-16(%r30),%r29	/* Reference param save area */
1007#endif
1008
1009	b	do_cpu_irq_mask
1010	ldo	R%intr_return(%r2), %r2	/* return to intr_return, not here */
1011ENDPROC_CFI(syscall_exit_rfi)
1012
1013
1014	/* Generic interruptions (illegal insn, unaligned, page fault, etc) */
1015
1016ENTRY_CFI(intr_save)		/* for os_hpmc */
1017	mfsp    %sr7,%r16
1018	cmpib,COND(=),n 0,%r16,1f
1019	get_stack_use_cr30
1020	b	2f
1021	copy    %r8,%r26
1022
10231:
1024	get_stack_use_r30
1025	copy    %r8,%r26
1026
10272:
1028	save_specials	%r29
1029
1030	/* If this trap is a itlb miss, skip saving/adjusting isr/ior */
1031	cmpib,COND(=),n        PARISC_ITLB_TRAP,%r26,skip_save_ior
 
 
 
 
 
 
 
 
 
1032
1033
1034	mfctl           %isr, %r16
1035	nop		/* serialize mfctl on PA 2.0 to avoid 4 cycle penalty */
1036	mfctl           %ior, %r17
1037
1038
1039#ifdef CONFIG_64BIT
1040	/*
1041	 * If the interrupted code was running with W bit off (32 bit),
1042	 * clear the b bits (bits 0 & 1) in the ior.
1043	 * save_specials left ipsw value in r8 for us to test.
1044	 */
1045	extrd,u,*<>     %r8,PSW_W_BIT,1,%r0
1046	depdi           0,1,2,%r17
1047
1048	/* adjust isr/ior: get high bits from isr and deposit in ior */
1049	space_adjust	%r16,%r17,%r1
 
 
 
 
 
 
 
 
1050#endif
1051	STREG           %r16, PT_ISR(%r29)
1052	STREG           %r17, PT_IOR(%r29)
1053
1054#if defined(CONFIG_64BIT)
1055	b,n		intr_save2
1056
1057skip_save_ior:
1058	/* We have a itlb miss, and when executing code above 4 Gb on ILP64, we
1059	 * need to adjust iasq/iaoq here in the same way we adjusted isr/ior
1060	 * above.
1061	 */
1062	bb,COND(>=),n	%r8,PSW_W_BIT,intr_save2
1063	LDREG		PT_IASQ0(%r29), %r16
1064	LDREG		PT_IAOQ0(%r29), %r17
1065	/* adjust iasq/iaoq */
1066	space_adjust	%r16,%r17,%r1
1067	STREG           %r16, PT_IASQ0(%r29)
1068	STREG           %r17, PT_IAOQ0(%r29)
1069#else
1070skip_save_ior:
1071#endif
1072
1073intr_save2:
1074	virt_map
1075	save_general	%r29
1076
1077	ldo		PT_FR0(%r29), %r25
1078	save_fp		%r25
1079	
1080	loadgp
1081
1082	copy		%r29, %r25	/* arg1 is pt_regs */
1083#ifdef CONFIG_64BIT
1084	ldo		-16(%r30),%r29	/* Reference param save area */
1085#endif
1086
1087	ldil		L%intr_check_sig, %r2
1088	copy		%r25, %r16	/* save pt_regs */
1089
1090	b		handle_interruption
1091	ldo		R%intr_check_sig(%r2), %r2
1092ENDPROC_CFI(intr_save)
1093
1094
1095	/*
1096	 * Note for all tlb miss handlers:
1097	 *
1098	 * cr24 contains a pointer to the kernel address space
1099	 * page directory.
1100	 *
1101	 * cr25 contains a pointer to the current user address
1102	 * space page directory.
1103	 *
1104	 * sr3 will contain the space id of the user address space
1105	 * of the current running thread while that thread is
1106	 * running in the kernel.
1107	 */
1108
1109	/*
1110	 * register number allocations.  Note that these are all
1111	 * in the shadowed registers
1112	 */
1113
1114	t0 = r1		/* temporary register 0 */
1115	va = r8		/* virtual address for which the trap occurred */
1116	t1 = r9		/* temporary register 1 */
1117	pte  = r16	/* pte/phys page # */
1118	prot = r17	/* prot bits */
1119	spc  = r24	/* space for which the trap occurred */
1120	ptp = r25	/* page directory/page table pointer */
1121
1122#ifdef CONFIG_64BIT
1123
1124dtlb_miss_20w:
1125	space_adjust	spc,va,t0
1126	get_pgd		spc,ptp
1127	space_check	spc,t0,dtlb_fault
1128
1129	L3_ptep		ptp,pte,t0,va,dtlb_check_alias_20w
1130
1131	ptl_lock	spc,ptp,pte,t0,t1,dtlb_check_alias_20w
1132	update_accessed	ptp,pte,t0,t1
1133
1134	make_insert_tlb	spc,pte,prot,t1
1135	
1136	idtlbt          pte,prot
1137
1138	ptl_unlock	spc,t0,t1
1139	rfir
1140	nop
1141
1142dtlb_check_alias_20w:
1143	do_alias	spc,t0,t1,va,pte,prot,dtlb_fault,20
1144
1145	idtlbt          pte,prot
1146
1147	insert_nops	NUM_PIPELINE_INSNS - 1
1148	rfir
1149	nop
1150
1151nadtlb_miss_20w:
1152	space_adjust	spc,va,t0
1153	get_pgd		spc,ptp
1154	space_check	spc,t0,nadtlb_fault
1155
1156	L3_ptep		ptp,pte,t0,va,nadtlb_check_alias_20w
1157
1158	ptl_lock	spc,ptp,pte,t0,t1,nadtlb_check_alias_20w
1159	update_accessed	ptp,pte,t0,t1
1160
1161	make_insert_tlb	spc,pte,prot,t1
1162
1163	idtlbt          pte,prot
1164
1165	ptl_unlock	spc,t0,t1
1166	rfir
1167	nop
1168
1169nadtlb_check_alias_20w:
1170	do_alias	spc,t0,t1,va,pte,prot,nadtlb_emulate,20
1171
1172	idtlbt          pte,prot
1173
1174	insert_nops	NUM_PIPELINE_INSNS - 1
1175	rfir
1176	nop
1177
1178#else
1179
1180dtlb_miss_11:
1181	get_pgd		spc,ptp
1182
1183	space_check	spc,t0,dtlb_fault
1184
1185	L2_ptep		ptp,pte,t0,va,dtlb_check_alias_11
1186
1187	ptl_lock	spc,ptp,pte,t0,t1,dtlb_check_alias_11
1188	update_accessed	ptp,pte,t0,t1
1189
1190	make_insert_tlb_11	spc,pte,prot
1191
1192	mfsp		%sr1,t1  /* Save sr1 so we can use it in tlb inserts */
1193	mtsp		spc,%sr1
1194
1195	idtlba		pte,(%sr1,va)
1196	idtlbp		prot,(%sr1,va)
1197
1198	mtsp		t1, %sr1	/* Restore sr1 */
1199
1200	ptl_unlock	spc,t0,t1
1201	rfir
1202	nop
1203
1204dtlb_check_alias_11:
1205	do_alias	spc,t0,t1,va,pte,prot,dtlb_fault,11
1206
1207	idtlba          pte,(va)
1208	idtlbp          prot,(va)
1209
1210	insert_nops	NUM_PIPELINE_INSNS - 1
1211	rfir
1212	nop
1213
1214nadtlb_miss_11:
1215	get_pgd		spc,ptp
1216
1217	space_check	spc,t0,nadtlb_fault
1218
1219	L2_ptep		ptp,pte,t0,va,nadtlb_check_alias_11
1220
1221	ptl_lock	spc,ptp,pte,t0,t1,nadtlb_check_alias_11
1222	update_accessed	ptp,pte,t0,t1
1223
1224	make_insert_tlb_11	spc,pte,prot
1225
1226	mfsp		%sr1,t1  /* Save sr1 so we can use it in tlb inserts */
 
1227	mtsp		spc,%sr1
1228
1229	idtlba		pte,(%sr1,va)
1230	idtlbp		prot,(%sr1,va)
1231
1232	mtsp		t1, %sr1	/* Restore sr1 */
1233
1234	ptl_unlock	spc,t0,t1
1235	rfir
1236	nop
1237
1238nadtlb_check_alias_11:
1239	do_alias	spc,t0,t1,va,pte,prot,nadtlb_emulate,11
1240
1241	idtlba          pte,(va)
1242	idtlbp          prot,(va)
1243
1244	insert_nops	NUM_PIPELINE_INSNS - 1
1245	rfir
1246	nop
1247
1248dtlb_miss_20:
1249	space_adjust	spc,va,t0
1250	get_pgd		spc,ptp
1251	space_check	spc,t0,dtlb_fault
1252
1253	L2_ptep		ptp,pte,t0,va,dtlb_check_alias_20
1254
1255	ptl_lock	spc,ptp,pte,t0,t1,dtlb_check_alias_20
1256	update_accessed	ptp,pte,t0,t1
1257
1258	make_insert_tlb	spc,pte,prot,t1
1259
1260	f_extend	pte,t1
1261
1262	idtlbt          pte,prot
1263
1264	ptl_unlock	spc,t0,t1
1265	rfir
1266	nop
1267
1268dtlb_check_alias_20:
1269	do_alias	spc,t0,t1,va,pte,prot,dtlb_fault,20
1270	
1271	idtlbt          pte,prot
1272
1273	insert_nops	NUM_PIPELINE_INSNS - 1
1274	rfir
1275	nop
1276
1277nadtlb_miss_20:
1278	get_pgd		spc,ptp
1279
1280	space_check	spc,t0,nadtlb_fault
1281
1282	L2_ptep		ptp,pte,t0,va,nadtlb_check_alias_20
1283
1284	ptl_lock	spc,ptp,pte,t0,t1,nadtlb_check_alias_20
1285	update_accessed	ptp,pte,t0,t1
1286
1287	make_insert_tlb	spc,pte,prot,t1
1288
1289	f_extend	pte,t1
1290	
1291	idtlbt		pte,prot
1292
1293	ptl_unlock	spc,t0,t1
1294	rfir
1295	nop
1296
1297nadtlb_check_alias_20:
1298	do_alias	spc,t0,t1,va,pte,prot,nadtlb_emulate,20
1299
1300	idtlbt          pte,prot
1301
1302	insert_nops	NUM_PIPELINE_INSNS - 1
1303	rfir
1304	nop
1305
1306#endif
1307
1308nadtlb_emulate:
1309
1310	/*
1311	 * Non-access misses can be caused by fdc,fic,pdc,lpa,probe and
1312	 * probei instructions. The kernel no longer faults doing flushes.
1313	 * Use of lpa and probe instructions is rare. Given the issue
1314	 * with shadow registers, we defer everything to the "slow" path.
1315	 */
1316	b,n		nadtlb_fault
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1317
1318#ifdef CONFIG_64BIT
1319itlb_miss_20w:
1320
1321	/*
1322	 * I miss is a little different, since we allow users to fault
1323	 * on the gateway page which is in the kernel address space.
1324	 */
1325
1326	space_adjust	spc,va,t0
1327	get_pgd		spc,ptp
1328	space_check	spc,t0,itlb_fault
1329
1330	L3_ptep		ptp,pte,t0,va,itlb_fault
1331
1332	ptl_lock	spc,ptp,pte,t0,t1,itlb_fault
1333	update_accessed	ptp,pte,t0,t1
1334
1335	make_insert_tlb	spc,pte,prot,t1
1336	
1337	iitlbt          pte,prot
1338
1339	ptl_unlock	spc,t0,t1
1340	rfir
1341	nop
1342
1343naitlb_miss_20w:
1344
1345	/*
1346	 * I miss is a little different, since we allow users to fault
1347	 * on the gateway page which is in the kernel address space.
1348	 */
1349
1350	space_adjust	spc,va,t0
1351	get_pgd		spc,ptp
1352	space_check	spc,t0,naitlb_fault
1353
1354	L3_ptep		ptp,pte,t0,va,naitlb_check_alias_20w
1355
1356	ptl_lock	spc,ptp,pte,t0,t1,naitlb_check_alias_20w
1357	update_accessed	ptp,pte,t0,t1
1358
1359	make_insert_tlb	spc,pte,prot,t1
1360
1361	iitlbt          pte,prot
1362
1363	ptl_unlock	spc,t0,t1
1364	rfir
1365	nop
1366
1367naitlb_check_alias_20w:
1368	do_alias	spc,t0,t1,va,pte,prot,naitlb_fault,20
1369
1370	iitlbt		pte,prot
1371
1372	insert_nops	NUM_PIPELINE_INSNS - 1
1373	rfir
1374	nop
1375
1376#else
1377
1378itlb_miss_11:
1379	get_pgd		spc,ptp
1380
1381	space_check	spc,t0,itlb_fault
1382
1383	L2_ptep		ptp,pte,t0,va,itlb_fault
1384
1385	ptl_lock	spc,ptp,pte,t0,t1,itlb_fault
1386	update_accessed	ptp,pte,t0,t1
1387
1388	make_insert_tlb_11	spc,pte,prot
1389
1390	mfsp		%sr1,t1  /* Save sr1 so we can use it in tlb inserts */
1391	mtsp		spc,%sr1
1392
1393	iitlba		pte,(%sr1,va)
1394	iitlbp		prot,(%sr1,va)
1395
1396	mtsp		t1, %sr1	/* Restore sr1 */
1397
1398	ptl_unlock	spc,t0,t1
1399	rfir
1400	nop
1401
1402naitlb_miss_11:
1403	get_pgd		spc,ptp
1404
1405	space_check	spc,t0,naitlb_fault
1406
1407	L2_ptep		ptp,pte,t0,va,naitlb_check_alias_11
1408
1409	ptl_lock	spc,ptp,pte,t0,t1,naitlb_check_alias_11
1410	update_accessed	ptp,pte,t0,t1
1411
1412	make_insert_tlb_11	spc,pte,prot
1413
1414	mfsp		%sr1,t1  /* Save sr1 so we can use it in tlb inserts */
1415	mtsp		spc,%sr1
1416
1417	iitlba		pte,(%sr1,va)
1418	iitlbp		prot,(%sr1,va)
1419
1420	mtsp		t1, %sr1	/* Restore sr1 */
1421
1422	ptl_unlock	spc,t0,t1
1423	rfir
1424	nop
1425
1426naitlb_check_alias_11:
1427	do_alias	spc,t0,t1,va,pte,prot,itlb_fault,11
1428
1429	iitlba          pte,(%sr0, va)
1430	iitlbp          prot,(%sr0, va)
1431
1432	insert_nops	NUM_PIPELINE_INSNS - 1
1433	rfir
1434	nop
1435
1436
1437itlb_miss_20:
1438	get_pgd		spc,ptp
1439
1440	space_check	spc,t0,itlb_fault
1441
1442	L2_ptep		ptp,pte,t0,va,itlb_fault
1443
1444	ptl_lock	spc,ptp,pte,t0,t1,itlb_fault
1445	update_accessed	ptp,pte,t0,t1
1446
1447	make_insert_tlb	spc,pte,prot,t1
1448
1449	f_extend	pte,t1
1450
1451	iitlbt          pte,prot
1452
1453	ptl_unlock	spc,t0,t1
1454	rfir
1455	nop
1456
1457naitlb_miss_20:
1458	get_pgd		spc,ptp
1459
1460	space_check	spc,t0,naitlb_fault
1461
1462	L2_ptep		ptp,pte,t0,va,naitlb_check_alias_20
1463
1464	ptl_lock	spc,ptp,pte,t0,t1,naitlb_check_alias_20
1465	update_accessed	ptp,pte,t0,t1
1466
1467	make_insert_tlb	spc,pte,prot,t1
1468
1469	f_extend	pte,t1
1470
1471	iitlbt          pte,prot
1472
1473	ptl_unlock	spc,t0,t1
1474	rfir
1475	nop
1476
1477naitlb_check_alias_20:
1478	do_alias	spc,t0,t1,va,pte,prot,naitlb_fault,20
1479
1480	iitlbt          pte,prot
1481
1482	insert_nops	NUM_PIPELINE_INSNS - 1
1483	rfir
1484	nop
1485
1486#endif
1487
1488#ifdef CONFIG_64BIT
1489
1490dbit_trap_20w:
1491	space_adjust	spc,va,t0
1492	get_pgd		spc,ptp
1493	space_check	spc,t0,dbit_fault
1494
1495	L3_ptep		ptp,pte,t0,va,dbit_fault
1496
1497	ptl_lock	spc,ptp,pte,t0,t1,dbit_fault
 
 
 
 
 
 
 
 
 
 
1498	update_dirty	ptp,pte,t1
1499
1500	make_insert_tlb	spc,pte,prot,t1
1501		
1502	idtlbt          pte,prot
 
 
 
 
 
 
 
1503
1504	ptl_unlock	spc,t0,t1
1505	rfir
1506	nop
1507#else
1508
1509dbit_trap_11:
1510
1511	get_pgd		spc,ptp
1512
1513	space_check	spc,t0,dbit_fault
1514
1515	L2_ptep		ptp,pte,t0,va,dbit_fault
1516
1517	ptl_lock	spc,ptp,pte,t0,t1,dbit_fault
 
 
 
 
 
 
 
 
 
 
1518	update_dirty	ptp,pte,t1
1519
1520	make_insert_tlb_11	spc,pte,prot
1521
1522	mfsp            %sr1,t1  /* Save sr1 so we can use it in tlb inserts */
1523	mtsp		spc,%sr1
1524
1525	idtlba		pte,(%sr1,va)
1526	idtlbp		prot,(%sr1,va)
1527
1528	mtsp            t1, %sr1     /* Restore sr1 */
 
 
 
 
 
 
 
1529
1530	ptl_unlock	spc,t0,t1
1531	rfir
1532	nop
1533
1534dbit_trap_20:
1535	get_pgd		spc,ptp
1536
1537	space_check	spc,t0,dbit_fault
1538
1539	L2_ptep		ptp,pte,t0,va,dbit_fault
1540
1541	ptl_lock	spc,ptp,pte,t0,t1,dbit_fault
 
 
 
 
 
 
 
 
 
 
1542	update_dirty	ptp,pte,t1
1543
1544	make_insert_tlb	spc,pte,prot,t1
1545
1546	f_extend	pte,t1
1547	
1548	idtlbt		pte,prot
 
 
 
 
 
 
 
 
1549
1550	ptl_unlock	spc,t0,t1
1551	rfir
1552	nop
1553#endif
1554
1555	.import handle_interruption,code
1556
1557kernel_bad_space:
1558	b               intr_save
1559	ldi             31,%r8  /* Use an unused code */
1560
1561dbit_fault:
1562	b               intr_save
1563	ldi             20,%r8
1564
1565itlb_fault:
1566	b               intr_save
1567	ldi             PARISC_ITLB_TRAP,%r8
1568
1569nadtlb_fault:
1570	b               intr_save
1571	ldi             17,%r8
1572
1573naitlb_fault:
1574	b               intr_save
1575	ldi             16,%r8
1576
1577dtlb_fault:
1578	b               intr_save
1579	ldi             15,%r8
1580
1581	/* Register saving semantics for system calls:
1582
1583	   %r1		   clobbered by system call macro in userspace
1584	   %r2		   saved in PT_REGS by gateway page
1585	   %r3  - %r18	   preserved by C code (saved by signal code)
1586	   %r19 - %r20	   saved in PT_REGS by gateway page
1587	   %r21 - %r22	   non-standard syscall args
1588			   stored in kernel stack by gateway page
1589	   %r23 - %r26	   arg3-arg0, saved in PT_REGS by gateway page
1590	   %r27 - %r30	   saved in PT_REGS by gateway page
1591	   %r31		   syscall return pointer
1592	 */
1593
1594	/* Floating point registers (FIXME: what do we do with these?)
1595
1596	   %fr0  - %fr3	   status/exception, not preserved
1597	   %fr4  - %fr7	   arguments
1598	   %fr8	 - %fr11   not preserved by C code
1599	   %fr12 - %fr21   preserved by C code
1600	   %fr22 - %fr31   not preserved by C code
1601	 */
1602
1603	.macro	reg_save regs
1604	STREG	%r3, PT_GR3(\regs)
1605	STREG	%r4, PT_GR4(\regs)
1606	STREG	%r5, PT_GR5(\regs)
1607	STREG	%r6, PT_GR6(\regs)
1608	STREG	%r7, PT_GR7(\regs)
1609	STREG	%r8, PT_GR8(\regs)
1610	STREG	%r9, PT_GR9(\regs)
1611	STREG   %r10,PT_GR10(\regs)
1612	STREG   %r11,PT_GR11(\regs)
1613	STREG   %r12,PT_GR12(\regs)
1614	STREG   %r13,PT_GR13(\regs)
1615	STREG   %r14,PT_GR14(\regs)
1616	STREG   %r15,PT_GR15(\regs)
1617	STREG   %r16,PT_GR16(\regs)
1618	STREG   %r17,PT_GR17(\regs)
1619	STREG   %r18,PT_GR18(\regs)
1620	.endm
1621
1622	.macro	reg_restore regs
1623	LDREG	PT_GR3(\regs), %r3
1624	LDREG	PT_GR4(\regs), %r4
1625	LDREG	PT_GR5(\regs), %r5
1626	LDREG	PT_GR6(\regs), %r6
1627	LDREG	PT_GR7(\regs), %r7
1628	LDREG	PT_GR8(\regs), %r8
1629	LDREG	PT_GR9(\regs), %r9
1630	LDREG   PT_GR10(\regs),%r10
1631	LDREG   PT_GR11(\regs),%r11
1632	LDREG   PT_GR12(\regs),%r12
1633	LDREG   PT_GR13(\regs),%r13
1634	LDREG   PT_GR14(\regs),%r14
1635	LDREG   PT_GR15(\regs),%r15
1636	LDREG   PT_GR16(\regs),%r16
1637	LDREG   PT_GR17(\regs),%r17
1638	LDREG   PT_GR18(\regs),%r18
1639	.endm
1640
1641	.macro	fork_like name
1642ENTRY_CFI(sys_\name\()_wrapper)
1643	mfctl	%cr30,%r1
1644	ldo	TASK_REGS(%r1),%r1
1645	reg_save %r1
1646	mfctl	%cr27, %r28
1647	ldil	L%sys_\name, %r31
1648	be	R%sys_\name(%sr4,%r31)
1649	STREG	%r28, PT_CR27(%r1)
1650ENDPROC_CFI(sys_\name\()_wrapper)
1651	.endm
1652
1653fork_like clone
1654fork_like clone3
1655fork_like fork
1656fork_like vfork
 
1657
1658	/* Set the return value for the child */
1659ENTRY(child_return)
1660	BL	schedule_tail, %r2
1661	nop
1662finish_child_return:
1663	mfctl	%cr30,%r1
 
 
 
 
 
 
 
 
1664	ldo	TASK_REGS(%r1),%r1	 /* get pt regs */
1665
1666	LDREG	PT_CR27(%r1), %r3
1667	mtctl	%r3, %cr27
1668	reg_restore %r1
1669	b	syscall_exit
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1670	copy	%r0,%r28
1671END(child_return)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1672
1673ENTRY_CFI(sys_rt_sigreturn_wrapper)
1674	mfctl	%cr30,%r26
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1675	ldo	TASK_REGS(%r26),%r26	/* get pt regs */
1676	/* Don't save regs, we are going to restore them from sigcontext. */
1677	STREG	%r2, -RP_OFFSET(%r30)
1678#ifdef CONFIG_64BIT
1679	ldo	FRAME_SIZE(%r30), %r30
1680	BL	sys_rt_sigreturn,%r2
1681	ldo	-16(%r30),%r29		/* Reference param save area */
1682#else
1683	BL	sys_rt_sigreturn,%r2
1684	ldo	FRAME_SIZE(%r30), %r30
1685#endif
1686
1687	ldo	-FRAME_SIZE(%r30), %r30
1688	LDREG	-RP_OFFSET(%r30), %r2
1689
1690	/* FIXME: I think we need to restore a few more things here. */
1691	mfctl	%cr30,%r1
1692	ldo	TASK_REGS(%r1),%r1	/* get pt regs */
1693	reg_restore %r1
1694
1695	/* If the signal was received while the process was blocked on a
1696	 * syscall, then r2 will take us to syscall_exit; otherwise r2 will
1697	 * take us to syscall_exit_rfi and on to intr_return.
1698	 */
1699	bv	%r0(%r2)
1700	LDREG	PT_GR28(%r1),%r28  /* reload original r28 for syscall_exit */
1701ENDPROC_CFI(sys_rt_sigreturn_wrapper)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1702
1703ENTRY(syscall_exit)
 
 
 
 
1704	/* NOTE: Not all syscalls exit this way.  rt_sigreturn will exit
1705	 * via syscall_exit_rfi if the signal was received while the process
1706	 * was running.
1707	 */
1708
1709	/* save return value now */
 
1710	mfctl     %cr30, %r1
 
1711	STREG     %r28,TASK_PT_GR28(%r1)
1712
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1713	/* Seems to me that dp could be wrong here, if the syscall involved
1714	 * calling a module, and nothing got round to restoring dp on return.
1715	 */
1716	loadgp
1717
1718syscall_check_resched:
1719
1720	/* check for reschedule */
1721	mfctl	%cr30,%r19
1722	LDREG	TASK_TI_FLAGS(%r19),%r19	/* long */
1723	bb,<,n	%r19, 31-TIF_NEED_RESCHED, syscall_do_resched /* forward */
1724
1725	.import do_signal,code
1726syscall_check_sig:
1727	mfctl	%cr30,%r19
1728	LDREG	TASK_TI_FLAGS(%r19),%r19
1729	ldi	(_TIF_USER_WORK_MASK & ~_TIF_NEED_RESCHED), %r26
1730	and,COND(<>)	%r19, %r26, %r0
1731	b,n	syscall_restore	/* skip past if we've nothing to do */
1732
1733syscall_do_signal:
1734	/* Save callee-save registers (for sigcontext).
1735	 * FIXME: After this point the process structure should be
1736	 * consistent with all the relevant state of the process
1737	 * before the syscall.  We need to verify this.
1738	 */
1739	mfctl	%cr30,%r1
1740	ldo	TASK_REGS(%r1), %r26		/* struct pt_regs *regs */
1741	reg_save %r26
1742
1743#ifdef CONFIG_64BIT
1744	ldo	-16(%r30),%r29			/* Reference param save area */
1745#endif
1746
1747	BL	do_notify_resume,%r2
1748	ldi	1, %r25				/* long in_syscall = 1 */
1749
1750	mfctl	%cr30,%r1
1751	ldo	TASK_REGS(%r1), %r20		/* reload pt_regs */
1752	reg_restore %r20
1753
1754	b,n     syscall_check_sig
1755
1756syscall_restore:
1757	mfctl	%cr30,%r1
1758
1759	/* Are we being ptraced? */
1760	LDREG	TASK_TI_FLAGS(%r1),%r19
1761	ldi	_TIF_SINGLESTEP|_TIF_BLOCKSTEP,%r2
1762	and,COND(=)	%r19,%r2,%r0
1763	b,n	syscall_restore_rfi
1764
1765	ldo	TASK_PT_FR31(%r1),%r19		   /* reload fpregs */
1766	rest_fp	%r19
1767
1768	LDREG	TASK_PT_SAR(%r1),%r19		   /* restore SAR */
1769	mtsar	%r19
1770
1771	LDREG	TASK_PT_GR2(%r1),%r2		   /* restore user rp */
1772	LDREG	TASK_PT_GR19(%r1),%r19
1773	LDREG   TASK_PT_GR20(%r1),%r20
1774	LDREG	TASK_PT_GR21(%r1),%r21
1775	LDREG	TASK_PT_GR22(%r1),%r22
1776	LDREG	TASK_PT_GR23(%r1),%r23
1777	LDREG	TASK_PT_GR24(%r1),%r24
1778	LDREG	TASK_PT_GR25(%r1),%r25
1779	LDREG	TASK_PT_GR26(%r1),%r26
1780	LDREG	TASK_PT_GR27(%r1),%r27	   /* restore user dp */
1781	LDREG	TASK_PT_GR28(%r1),%r28	   /* syscall return value */
1782	LDREG	TASK_PT_GR29(%r1),%r29
1783	LDREG	TASK_PT_GR31(%r1),%r31	   /* restore syscall rp */
1784
1785	/* NOTE: We use rsm/ssm pair to make this operation atomic */
1786	LDREG   TASK_PT_GR30(%r1),%r1              /* Get user sp */
1787	rsm     PSW_SM_I, %r0
1788	copy    %r1,%r30                           /* Restore user sp */
1789	mfsp    %sr3,%r1                           /* Get user space id */
1790	mtsp    %r1,%sr7                           /* Restore sr7 */
1791	ssm     PSW_SM_I, %r0
1792
1793	/* Set sr2 to zero for userspace syscalls to work. */
1794	mtsp	%r0,%sr2 
1795	mtsp	%r1,%sr4			   /* Restore sr4 */
1796	mtsp	%r1,%sr5			   /* Restore sr5 */
1797	mtsp	%r1,%sr6			   /* Restore sr6 */
1798
1799	depi	PRIV_USER,31,2,%r31	/* ensure return to user mode. */
1800
1801#ifdef CONFIG_64BIT
1802	/* decide whether to reset the wide mode bit
1803	 *
1804	 * For a syscall, the W bit is stored in the lowest bit
1805	 * of sp.  Extract it and reset W if it is zero */
1806	extrd,u,*<>	%r30,63,1,%r1
1807	rsm	PSW_SM_W, %r0
1808	/* now reset the lowest bit of sp if it was set */
1809	xor	%r30,%r1,%r30
1810#endif
1811	be,n    0(%sr3,%r31)                       /* return to user space */
1812
1813	/* We have to return via an RFI, so that PSW T and R bits can be set
1814	 * appropriately.
1815	 * This sets up pt_regs so we can return via intr_restore, which is not
1816	 * the most efficient way of doing things, but it works.
1817	 */
1818syscall_restore_rfi:
1819	ldo	-1(%r0),%r2			   /* Set recovery cntr to -1 */
1820	mtctl	%r2,%cr0			   /*   for immediate trap */
1821	LDREG	TASK_PT_PSW(%r1),%r2		   /* Get old PSW */
1822	ldi	0x0b,%r20			   /* Create new PSW */
1823	depi	-1,13,1,%r20			   /* C, Q, D, and I bits */
1824
1825	/* The values of SINGLESTEP_BIT and BLOCKSTEP_BIT are
1826	 * set in thread_info.h and converted to PA bitmap
1827	 * numbers in asm-offsets.c */
1828
1829	/* if ((%r19.SINGLESTEP_BIT)) { %r20.27=1} */
1830	extru,=	%r19,TIF_SINGLESTEP_PA_BIT,1,%r0
1831	depi	-1,27,1,%r20			   /* R bit */
1832
1833	/* if ((%r19.BLOCKSTEP_BIT)) { %r20.7=1} */
1834	extru,= %r19,TIF_BLOCKSTEP_PA_BIT,1,%r0
1835	depi	-1,7,1,%r20			   /* T bit */
1836
1837	STREG	%r20,TASK_PT_PSW(%r1)
1838
1839	/* Always store space registers, since sr3 can be changed (e.g. fork) */
1840
1841	mfsp    %sr3,%r25
1842	STREG   %r25,TASK_PT_SR3(%r1)
1843	STREG   %r25,TASK_PT_SR4(%r1)
1844	STREG   %r25,TASK_PT_SR5(%r1)
1845	STREG   %r25,TASK_PT_SR6(%r1)
1846	STREG   %r25,TASK_PT_SR7(%r1)
1847	STREG   %r25,TASK_PT_IASQ0(%r1)
1848	STREG   %r25,TASK_PT_IASQ1(%r1)
1849
1850	/* XXX W bit??? */
1851	/* Now if old D bit is clear, it means we didn't save all registers
1852	 * on syscall entry, so do that now.  This only happens on TRACEME
1853	 * calls, or if someone attached to us while we were on a syscall.
1854	 * We could make this more efficient by not saving r3-r18, but
1855	 * then we wouldn't be able to use the common intr_restore path.
1856	 * It is only for traced processes anyway, so performance is not
1857	 * an issue.
1858	 */
1859	bb,<	%r2,30,pt_regs_ok		   /* Branch if D set */
1860	ldo	TASK_REGS(%r1),%r25
1861	reg_save %r25				   /* Save r3 to r18 */
1862
1863	/* Save the current sr */
1864	mfsp	%sr0,%r2
1865	STREG	%r2,TASK_PT_SR0(%r1)
1866
1867	/* Save the scratch sr */
1868	mfsp	%sr1,%r2
1869	STREG	%r2,TASK_PT_SR1(%r1)
1870
1871	/* sr2 should be set to zero for userspace syscalls */
1872	STREG	%r0,TASK_PT_SR2(%r1)
1873
 
1874	LDREG	TASK_PT_GR31(%r1),%r2
1875	depi	PRIV_USER,31,2,%r2	/* ensure return to user mode. */
1876	STREG   %r2,TASK_PT_IAOQ0(%r1)
1877	ldo	4(%r2),%r2
1878	STREG	%r2,TASK_PT_IAOQ1(%r1)
1879	b	intr_restore
1880	copy	%r25,%r16
1881
1882pt_regs_ok:
1883	LDREG	TASK_PT_IAOQ0(%r1),%r2
1884	depi	PRIV_USER,31,2,%r2	/* ensure return to user mode. */
1885	STREG	%r2,TASK_PT_IAOQ0(%r1)
1886	LDREG	TASK_PT_IAOQ1(%r1),%r2
1887	depi	PRIV_USER,31,2,%r2
1888	STREG	%r2,TASK_PT_IAOQ1(%r1)
1889	b	intr_restore
1890	copy	%r25,%r16
1891
 
1892syscall_do_resched:
1893	load32	syscall_check_resched,%r2 /* if resched, we start over again */
1894	load32	schedule,%r19
1895	bv	%r0(%r19)		/* jumps to schedule() */
1896#ifdef CONFIG_64BIT
1897	ldo	-16(%r30),%r29		/* Reference param save area */
1898#else
1899	nop
1900#endif
1901END(syscall_exit)
 
 
1902
1903
1904#ifdef CONFIG_FUNCTION_TRACER
1905
1906	.import ftrace_function_trampoline,code
1907	.align L1_CACHE_BYTES
1908ENTRY_CFI(mcount, caller)
1909_mcount:
1910	.export _mcount,data
1911	/*
1912	 * The 64bit mcount() function pointer needs 4 dwords, of which the
1913	 * first two are free.  We optimize it here and put 2 instructions for
1914	 * calling mcount(), and 2 instructions for ftrace_stub().  That way we
1915	 * have all on one L1 cacheline.
1916	 */
1917	ldi	0, %arg3
1918	b	ftrace_function_trampoline
1919	copy	%r3, %arg2	/* caller original %sp */
1920ftrace_stub:
1921	.globl ftrace_stub
1922        .type  ftrace_stub, @function
1923#ifdef CONFIG_64BIT
1924	bve	(%rp)
1925#else
1926	bv	%r0(%rp)
1927#endif
1928	nop
1929#ifdef CONFIG_64BIT
1930	.dword mcount
1931	.dword 0 /* code in head.S puts value of global gp here */
1932#endif
1933ENDPROC_CFI(mcount)
1934
1935#ifdef CONFIG_DYNAMIC_FTRACE
1936
1937#ifdef CONFIG_64BIT
1938#define FTRACE_FRAME_SIZE (2*FRAME_SIZE)
1939#else
1940#define FTRACE_FRAME_SIZE FRAME_SIZE
1941#endif
1942ENTRY_CFI(ftrace_caller, caller,frame=FTRACE_FRAME_SIZE,CALLS,SAVE_RP,SAVE_SP)
1943ftrace_caller:
1944	.global ftrace_caller
1945
1946	STREG	%r3, -FTRACE_FRAME_SIZE+1*REG_SZ(%sp)
1947	ldo	-FTRACE_FRAME_SIZE(%sp), %r3
1948	STREG	%rp, -RP_OFFSET(%r3)
1949
1950	/* Offset 0 is already allocated for %r1 */
1951	STREG	%r23, 2*REG_SZ(%r3)
1952	STREG	%r24, 3*REG_SZ(%r3)
1953	STREG	%r25, 4*REG_SZ(%r3)
1954	STREG	%r26, 5*REG_SZ(%r3)
1955	STREG	%r28, 6*REG_SZ(%r3)
1956	STREG	%r29, 7*REG_SZ(%r3)
1957#ifdef CONFIG_64BIT
1958	STREG	%r19, 8*REG_SZ(%r3)
1959	STREG	%r20, 9*REG_SZ(%r3)
1960	STREG	%r21, 10*REG_SZ(%r3)
1961	STREG	%r22, 11*REG_SZ(%r3)
1962	STREG	%r27, 12*REG_SZ(%r3)
1963	STREG	%r31, 13*REG_SZ(%r3)
1964	loadgp
1965	ldo	-16(%sp),%r29
1966#endif
1967	LDREG	0(%r3), %r25
1968	copy	%rp, %r26
1969	ldo	-8(%r25), %r25
1970	ldi	0, %r23		/* no pt_regs */
1971	b,l	ftrace_function_trampoline, %rp
1972	copy	%r3, %r24
1973
1974	LDREG	-RP_OFFSET(%r3), %rp
1975	LDREG	2*REG_SZ(%r3), %r23
1976	LDREG	3*REG_SZ(%r3), %r24
1977	LDREG	4*REG_SZ(%r3), %r25
1978	LDREG	5*REG_SZ(%r3), %r26
1979	LDREG	6*REG_SZ(%r3), %r28
1980	LDREG	7*REG_SZ(%r3), %r29
1981#ifdef CONFIG_64BIT
1982	LDREG	8*REG_SZ(%r3), %r19
1983	LDREG	9*REG_SZ(%r3), %r20
1984	LDREG	10*REG_SZ(%r3), %r21
1985	LDREG	11*REG_SZ(%r3), %r22
1986	LDREG	12*REG_SZ(%r3), %r27
1987	LDREG	13*REG_SZ(%r3), %r31
1988#endif
1989	LDREG	1*REG_SZ(%r3), %r3
1990
1991	LDREGM	-FTRACE_FRAME_SIZE(%sp), %r1
1992	/* Adjust return point to jump back to beginning of traced function */
1993	ldo	-4(%r1), %r1
1994	bv,n	(%r1)
1995
1996ENDPROC_CFI(ftrace_caller)
1997
1998#ifdef CONFIG_HAVE_DYNAMIC_FTRACE_WITH_REGS
1999ENTRY_CFI(ftrace_regs_caller,caller,frame=FTRACE_FRAME_SIZE+PT_SZ_ALGN,
2000	CALLS,SAVE_RP,SAVE_SP)
2001ftrace_regs_caller:
2002	.global ftrace_regs_caller
2003
2004	ldo	-FTRACE_FRAME_SIZE(%sp), %r1
2005	STREG	%rp, -RP_OFFSET(%r1)
2006
2007	copy	%sp, %r1
2008	ldo	PT_SZ_ALGN(%sp), %sp
2009
2010	STREG	%rp, PT_GR2(%r1)
2011	STREG	%r3, PT_GR3(%r1)
2012	STREG	%r4, PT_GR4(%r1)
2013	STREG	%r5, PT_GR5(%r1)
2014	STREG	%r6, PT_GR6(%r1)
2015	STREG	%r7, PT_GR7(%r1)
2016	STREG	%r8, PT_GR8(%r1)
2017	STREG	%r9, PT_GR9(%r1)
2018	STREG   %r10, PT_GR10(%r1)
2019	STREG   %r11, PT_GR11(%r1)
2020	STREG   %r12, PT_GR12(%r1)
2021	STREG   %r13, PT_GR13(%r1)
2022	STREG   %r14, PT_GR14(%r1)
2023	STREG   %r15, PT_GR15(%r1)
2024	STREG   %r16, PT_GR16(%r1)
2025	STREG   %r17, PT_GR17(%r1)
2026	STREG   %r18, PT_GR18(%r1)
2027	STREG	%r19, PT_GR19(%r1)
2028	STREG	%r20, PT_GR20(%r1)
2029	STREG	%r21, PT_GR21(%r1)
2030	STREG	%r22, PT_GR22(%r1)
2031	STREG	%r23, PT_GR23(%r1)
2032	STREG	%r24, PT_GR24(%r1)
2033	STREG	%r25, PT_GR25(%r1)
2034	STREG	%r26, PT_GR26(%r1)
2035	STREG	%r27, PT_GR27(%r1)
2036	STREG	%r28, PT_GR28(%r1)
2037	STREG	%r29, PT_GR29(%r1)
2038	STREG	%r30, PT_GR30(%r1)
2039	STREG	%r31, PT_GR31(%r1)
2040	mfctl	%cr11, %r26
2041	STREG	%r26, PT_SAR(%r1)
2042
2043	copy	%rp, %r26
2044	LDREG	-FTRACE_FRAME_SIZE-PT_SZ_ALGN(%sp), %r25
2045	ldo	-8(%r25), %r25
2046	ldo	-FTRACE_FRAME_SIZE(%r1), %arg2
2047	b,l	ftrace_function_trampoline, %rp
2048	copy	%r1, %arg3 /* struct pt_regs */
2049
2050	ldo	-PT_SZ_ALGN(%sp), %r1
2051
2052	LDREG	PT_SAR(%r1), %rp
2053	mtctl	%rp, %cr11
2054
2055	LDREG	PT_GR2(%r1), %rp
2056	LDREG	PT_GR3(%r1), %r3
2057	LDREG	PT_GR4(%r1), %r4
2058	LDREG	PT_GR5(%r1), %r5
2059	LDREG	PT_GR6(%r1), %r6
2060	LDREG	PT_GR7(%r1), %r7
2061	LDREG	PT_GR8(%r1), %r8
2062	LDREG	PT_GR9(%r1), %r9
2063	LDREG   PT_GR10(%r1),%r10
2064	LDREG   PT_GR11(%r1),%r11
2065	LDREG   PT_GR12(%r1),%r12
2066	LDREG   PT_GR13(%r1),%r13
2067	LDREG   PT_GR14(%r1),%r14
2068	LDREG   PT_GR15(%r1),%r15
2069	LDREG   PT_GR16(%r1),%r16
2070	LDREG   PT_GR17(%r1),%r17
2071	LDREG   PT_GR18(%r1),%r18
2072	LDREG   PT_GR19(%r1),%r19
2073	LDREG   PT_GR20(%r1),%r20
2074	LDREG   PT_GR21(%r1),%r21
2075	LDREG   PT_GR22(%r1),%r22
2076	LDREG   PT_GR23(%r1),%r23
2077	LDREG   PT_GR24(%r1),%r24
2078	LDREG   PT_GR25(%r1),%r25
2079	LDREG   PT_GR26(%r1),%r26
2080	LDREG   PT_GR27(%r1),%r27
2081	LDREG   PT_GR28(%r1),%r28
2082	LDREG   PT_GR29(%r1),%r29
2083	LDREG   PT_GR30(%r1),%r30
2084	LDREG   PT_GR31(%r1),%r31
2085
2086	ldo	-PT_SZ_ALGN(%sp), %sp
2087	LDREGM	-FTRACE_FRAME_SIZE(%sp), %r1
2088	/* Adjust return point to jump back to beginning of traced function */
2089	ldo	-4(%r1), %r1
2090	bv,n	(%r1)
2091
2092ENDPROC_CFI(ftrace_regs_caller)
2093
2094#endif
2095#endif
2096
2097#ifdef CONFIG_FUNCTION_GRAPH_TRACER
2098	.align 8
2099ENTRY_CFI(return_to_handler, caller,frame=FRAME_SIZE)
2100	.export parisc_return_to_handler,data
2101parisc_return_to_handler:
2102	copy %r3,%r1
2103	STREG %r0,-RP_OFFSET(%sp)	/* store 0 as %rp */
2104	copy %sp,%r3
2105	STREGM %r1,FRAME_SIZE(%sp)
2106	STREG %ret0,8(%r3)
2107	STREG %ret1,16(%r3)
2108
2109#ifdef CONFIG_64BIT
2110	loadgp
2111#endif
2112
2113	/* call ftrace_return_to_handler(0) */
2114	.import ftrace_return_to_handler,code
2115	load32 ftrace_return_to_handler,%ret0
2116	load32 .Lftrace_ret,%r2
2117#ifdef CONFIG_64BIT
2118	ldo -16(%sp),%ret1		/* Reference param save area */
2119	bve	(%ret0)
2120#else
2121	bv	%r0(%ret0)
2122#endif
2123	ldi 0,%r26
2124.Lftrace_ret:
2125	copy %ret0,%rp
2126
2127	/* restore original return values */
2128	LDREG 8(%r3),%ret0
2129	LDREG 16(%r3),%ret1
 
 
 
 
 
 
 
2130
2131	/* return from function */
2132#ifdef CONFIG_64BIT
2133	bve	(%rp)
2134#else
2135	bv	%r0(%rp)
2136#endif
2137	LDREGM -FRAME_SIZE(%sp),%r3
2138ENDPROC_CFI(return_to_handler)
2139
2140#endif /* CONFIG_FUNCTION_GRAPH_TRACER */
2141
2142#endif	/* CONFIG_FUNCTION_TRACER */
2143
2144#ifdef CONFIG_IRQSTACKS
2145/* void call_on_stack(unsigned long param1, void *func,
2146		      unsigned long new_stack) */
2147ENTRY_CFI(call_on_stack, FRAME=2*FRAME_SIZE,CALLS,SAVE_RP,SAVE_SP)
2148ENTRY(_call_on_stack)
2149	copy	%sp, %r1
2150
2151	/* Regarding the HPPA calling conventions for function pointers,
2152	   we assume the PIC register is not changed across call.  For
2153	   CONFIG_64BIT, the argument pointer is left to point at the
2154	   argument region allocated for the call to call_on_stack. */
2155
2156	/* Switch to new stack.  We allocate two frames.  */
2157	ldo	2*FRAME_SIZE(%arg2), %sp
2158# ifdef CONFIG_64BIT
2159	/* Save previous stack pointer and return pointer in frame marker */
2160	STREG	%rp, -FRAME_SIZE-RP_OFFSET(%sp)
2161	/* Calls always use function descriptor */
2162	LDREG	16(%arg1), %arg1
2163	bve,l	(%arg1), %rp
2164	STREG	%r1, -FRAME_SIZE-REG_SZ(%sp)
2165	LDREG	-FRAME_SIZE-RP_OFFSET(%sp), %rp
2166	bve	(%rp)
2167	LDREG	-FRAME_SIZE-REG_SZ(%sp), %sp
2168# else
2169	/* Save previous stack pointer and return pointer in frame marker */
2170	STREG	%r1, -FRAME_SIZE-REG_SZ(%sp)
2171	STREG	%rp, -FRAME_SIZE-RP_OFFSET(%sp)
2172	/* Calls use function descriptor if PLABEL bit is set */
2173	bb,>=,n	%arg1, 30, 1f
2174	depwi	0,31,2, %arg1
2175	LDREG	0(%arg1), %arg1
21761:
2177	be,l	0(%sr4,%arg1), %sr0, %r31
2178	copy	%r31, %rp
2179	LDREG	-FRAME_SIZE-RP_OFFSET(%sp), %rp
2180	bv	(%rp)
2181	LDREG	-FRAME_SIZE-REG_SZ(%sp), %sp
2182# endif /* CONFIG_64BIT */
2183ENDPROC_CFI(call_on_stack)
2184#endif /* CONFIG_IRQSTACKS */
2185
2186ENTRY_CFI(get_register)
2187	/*
2188	 * get_register is used by the non access tlb miss handlers to
2189	 * copy the value of the general register specified in r8 into
2190	 * r1. This routine can't be used for shadowed registers, since
2191	 * the rfir will restore the original value. So, for the shadowed
2192	 * registers we put a -1 into r1 to indicate that the register
2193	 * should not be used (the register being copied could also have
2194	 * a -1 in it, but that is OK, it just means that we will have
2195	 * to use the slow path instead).
2196	 */
2197	blr     %r8,%r0
2198	nop
2199	bv      %r0(%r25)    /* r0 */
2200	copy    %r0,%r1
2201	bv      %r0(%r25)    /* r1 - shadowed */
2202	ldi     -1,%r1
2203	bv      %r0(%r25)    /* r2 */
2204	copy    %r2,%r1
2205	bv      %r0(%r25)    /* r3 */
2206	copy    %r3,%r1
2207	bv      %r0(%r25)    /* r4 */
2208	copy    %r4,%r1
2209	bv      %r0(%r25)    /* r5 */
2210	copy    %r5,%r1
2211	bv      %r0(%r25)    /* r6 */
2212	copy    %r6,%r1
2213	bv      %r0(%r25)    /* r7 */
2214	copy    %r7,%r1
2215	bv      %r0(%r25)    /* r8 - shadowed */
2216	ldi     -1,%r1
2217	bv      %r0(%r25)    /* r9 - shadowed */
2218	ldi     -1,%r1
2219	bv      %r0(%r25)    /* r10 */
2220	copy    %r10,%r1
2221	bv      %r0(%r25)    /* r11 */
2222	copy    %r11,%r1
2223	bv      %r0(%r25)    /* r12 */
2224	copy    %r12,%r1
2225	bv      %r0(%r25)    /* r13 */
2226	copy    %r13,%r1
2227	bv      %r0(%r25)    /* r14 */
2228	copy    %r14,%r1
2229	bv      %r0(%r25)    /* r15 */
2230	copy    %r15,%r1
2231	bv      %r0(%r25)    /* r16 - shadowed */
2232	ldi     -1,%r1
2233	bv      %r0(%r25)    /* r17 - shadowed */
2234	ldi     -1,%r1
2235	bv      %r0(%r25)    /* r18 */
2236	copy    %r18,%r1
2237	bv      %r0(%r25)    /* r19 */
2238	copy    %r19,%r1
2239	bv      %r0(%r25)    /* r20 */
2240	copy    %r20,%r1
2241	bv      %r0(%r25)    /* r21 */
2242	copy    %r21,%r1
2243	bv      %r0(%r25)    /* r22 */
2244	copy    %r22,%r1
2245	bv      %r0(%r25)    /* r23 */
2246	copy    %r23,%r1
2247	bv      %r0(%r25)    /* r24 - shadowed */
2248	ldi     -1,%r1
2249	bv      %r0(%r25)    /* r25 - shadowed */
2250	ldi     -1,%r1
2251	bv      %r0(%r25)    /* r26 */
2252	copy    %r26,%r1
2253	bv      %r0(%r25)    /* r27 */
2254	copy    %r27,%r1
2255	bv      %r0(%r25)    /* r28 */
2256	copy    %r28,%r1
2257	bv      %r0(%r25)    /* r29 */
2258	copy    %r29,%r1
2259	bv      %r0(%r25)    /* r30 */
2260	copy    %r30,%r1
2261	bv      %r0(%r25)    /* r31 */
2262	copy    %r31,%r1
2263ENDPROC_CFI(get_register)
2264
2265
2266ENTRY_CFI(set_register)
2267	/*
2268	 * set_register is used by the non access tlb miss handlers to
2269	 * copy the value of r1 into the general register specified in
2270	 * r8.
2271	 */
2272	blr     %r8,%r0
2273	nop
2274	bv      %r0(%r25)    /* r0 (silly, but it is a place holder) */
2275	copy    %r1,%r0
2276	bv      %r0(%r25)    /* r1 */
2277	copy    %r1,%r1
2278	bv      %r0(%r25)    /* r2 */
2279	copy    %r1,%r2
2280	bv      %r0(%r25)    /* r3 */
2281	copy    %r1,%r3
2282	bv      %r0(%r25)    /* r4 */
2283	copy    %r1,%r4
2284	bv      %r0(%r25)    /* r5 */
2285	copy    %r1,%r5
2286	bv      %r0(%r25)    /* r6 */
2287	copy    %r1,%r6
2288	bv      %r0(%r25)    /* r7 */
2289	copy    %r1,%r7
2290	bv      %r0(%r25)    /* r8 */
2291	copy    %r1,%r8
2292	bv      %r0(%r25)    /* r9 */
2293	copy    %r1,%r9
2294	bv      %r0(%r25)    /* r10 */
2295	copy    %r1,%r10
2296	bv      %r0(%r25)    /* r11 */
2297	copy    %r1,%r11
2298	bv      %r0(%r25)    /* r12 */
2299	copy    %r1,%r12
2300	bv      %r0(%r25)    /* r13 */
2301	copy    %r1,%r13
2302	bv      %r0(%r25)    /* r14 */
2303	copy    %r1,%r14
2304	bv      %r0(%r25)    /* r15 */
2305	copy    %r1,%r15
2306	bv      %r0(%r25)    /* r16 */
2307	copy    %r1,%r16
2308	bv      %r0(%r25)    /* r17 */
2309	copy    %r1,%r17
2310	bv      %r0(%r25)    /* r18 */
2311	copy    %r1,%r18
2312	bv      %r0(%r25)    /* r19 */
2313	copy    %r1,%r19
2314	bv      %r0(%r25)    /* r20 */
2315	copy    %r1,%r20
2316	bv      %r0(%r25)    /* r21 */
2317	copy    %r1,%r21
2318	bv      %r0(%r25)    /* r22 */
2319	copy    %r1,%r22
2320	bv      %r0(%r25)    /* r23 */
2321	copy    %r1,%r23
2322	bv      %r0(%r25)    /* r24 */
2323	copy    %r1,%r24
2324	bv      %r0(%r25)    /* r25 */
2325	copy    %r1,%r25
2326	bv      %r0(%r25)    /* r26 */
2327	copy    %r1,%r26
2328	bv      %r0(%r25)    /* r27 */
2329	copy    %r1,%r27
2330	bv      %r0(%r25)    /* r28 */
2331	copy    %r1,%r28
2332	bv      %r0(%r25)    /* r29 */
2333	copy    %r1,%r29
2334	bv      %r0(%r25)    /* r30 */
2335	copy    %r1,%r30
2336	bv      %r0(%r25)    /* r31 */
2337	copy    %r1,%r31
2338ENDPROC_CFI(set_register)
2339
v3.5.6
 
   1/*
   2 * Linux/PA-RISC Project (http://www.parisc-linux.org/)
   3 *
   4 * kernel entry points (interruptions, system call wrappers)
   5 *  Copyright (C) 1999,2000 Philipp Rumpf 
   6 *  Copyright (C) 1999 SuSE GmbH Nuernberg 
   7 *  Copyright (C) 2000 Hewlett-Packard (John Marvin)
   8 *  Copyright (C) 1999 Hewlett-Packard (Frank Rowand)
   9 *
  10 *    This program is free software; you can redistribute it and/or modify
  11 *    it under the terms of the GNU General Public License as published by
  12 *    the Free Software Foundation; either version 2, or (at your option)
  13 *    any later version.
  14 *
  15 *    This program is distributed in the hope that it will be useful,
  16 *    but WITHOUT ANY WARRANTY; without even the implied warranty of
  17 *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18 *    GNU General Public License for more details.
  19 *
  20 *    You should have received a copy of the GNU General Public License
  21 *    along with this program; if not, write to the Free Software
  22 *    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  23 */
  24
  25#include <asm/asm-offsets.h>
  26
  27/* we have the following possibilities to act on an interruption:
  28 *  - handle in assembly and use shadowed registers only
  29 *  - save registers to kernel stack and handle in assembly or C */
  30
  31
  32#include <asm/psw.h>
  33#include <asm/cache.h>		/* for L1_CACHE_SHIFT */
  34#include <asm/assembly.h>	/* for LDREG/STREG defines */
  35#include <asm/pgtable.h>
  36#include <asm/signal.h>
  37#include <asm/unistd.h>
 
 
  38#include <asm/thread_info.h>
 
 
  39
  40#include <linux/linkage.h>
 
  41
  42#ifdef CONFIG_64BIT
  43	.level 2.0w
  44#else
  45	.level 2.0
  46#endif
  47
  48	.import         pa_dbit_lock,data
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  49
  50	/* space_to_prot macro creates a prot id from a space id */
  51
  52#if (SPACEID_SHIFT) == 0
  53	.macro  space_to_prot spc prot
  54	depd,z  \spc,62,31,\prot
  55	.endm
  56#else
  57	.macro  space_to_prot spc prot
  58	extrd,u \spc,(64 - (SPACEID_SHIFT)),32,\prot
  59	.endm
  60#endif
  61
  62	/* Switch to virtual mapping, trashing only %r1 */
  63	.macro  virt_map
  64	/* pcxt_ssm_bug */
  65	rsm	PSW_SM_I, %r0	/* barrier for "Relied upon Translation */
  66	mtsp	%r0, %sr4
  67	mtsp	%r0, %sr5
  68	mfsp	%sr7, %r1
  69	or,=    %r0,%r1,%r0	/* Only save sr7 in sr3 if sr7 != 0 */
  70	mtsp	%r1, %sr3
  71	tovirt_r1 %r29
  72	load32	KERNEL_PSW, %r1
  73
  74	rsm     PSW_SM_QUIET,%r0	/* second "heavy weight" ctl op */
  75	mtsp	%r0, %sr6
  76	mtsp	%r0, %sr7
  77	mtctl	%r0, %cr17	/* Clear IIASQ tail */
  78	mtctl	%r0, %cr17	/* Clear IIASQ head */
  79	mtctl	%r1, %ipsw
  80	load32	4f, %r1
  81	mtctl	%r1, %cr18	/* Set IIAOQ tail */
  82	ldo	4(%r1), %r1
  83	mtctl	%r1, %cr18	/* Set IIAOQ head */
  84	rfir
  85	nop
  864:
  87	.endm
  88
  89	/*
  90	 * The "get_stack" macros are responsible for determining the
  91	 * kernel stack value.
  92	 *
  93	 *      If sr7 == 0
  94	 *          Already using a kernel stack, so call the
  95	 *          get_stack_use_r30 macro to push a pt_regs structure
  96	 *          on the stack, and store registers there.
  97	 *      else
  98	 *          Need to set up a kernel stack, so call the
  99	 *          get_stack_use_cr30 macro to set up a pointer
 100	 *          to the pt_regs structure contained within the
 101	 *          task pointer pointed to by cr30. Set the stack
 102	 *          pointer to point to the end of the task structure.
 103	 *
 104	 * Note that we use shadowed registers for temps until
 105	 * we can save %r26 and %r29. %r26 is used to preserve
 106	 * %r8 (a shadowed register) which temporarily contained
 107	 * either the fault type ("code") or the eirr. We need
 108	 * to use a non-shadowed register to carry the value over
 109	 * the rfir in virt_map. We use %r26 since this value winds
 110	 * up being passed as the argument to either do_cpu_irq_mask
 111	 * or handle_interruption. %r29 is used to hold a pointer
 112	 * the register save area, and once again, it needs to
 113	 * be a non-shadowed register so that it survives the rfir.
 114	 *
 115	 * N.B. TASK_SZ_ALGN and PT_SZ_ALGN include space for a stack frame.
 116	 */
 117
 118	.macro  get_stack_use_cr30
 119
 120	/* we save the registers in the task struct */
 121
 
 122	mfctl   %cr30, %r1
 123	tophys  %r1,%r9
 124	LDREG	TI_TASK(%r9), %r1	/* thread_info -> task_struct */
 125	tophys  %r1,%r9
 
 
 126	ldo     TASK_REGS(%r9),%r9
 127	STREG   %r30, PT_GR30(%r9)
 128	STREG   %r29,PT_GR29(%r9)
 129	STREG   %r26,PT_GR26(%r9)
 
 130	copy    %r9,%r29
 131	mfctl   %cr30, %r1
 132	ldo	THREAD_SZ_ALGN(%r1), %r30
 133	.endm
 134
 135	.macro  get_stack_use_r30
 136
 137	/* we put a struct pt_regs on the stack and save the registers there */
 138
 139	tophys  %r30,%r9
 140	STREG   %r30,PT_GR30(%r9)
 141	ldo	PT_SZ_ALGN(%r30),%r30
 
 142	STREG   %r29,PT_GR29(%r9)
 143	STREG   %r26,PT_GR26(%r9)
 
 144	copy    %r9,%r29
 145	.endm
 146
 147	.macro  rest_stack
 148	LDREG   PT_GR1(%r29), %r1
 149	LDREG   PT_GR30(%r29),%r30
 150	LDREG   PT_GR29(%r29),%r29
 151	.endm
 152
 153	/* default interruption handler
 154	 * (calls traps.c:handle_interruption) */
 155	.macro	def code
 156	b	intr_save
 157	ldi     \code, %r8
 158	.align	32
 159	.endm
 160
 161	/* Interrupt interruption handler
 162	 * (calls irq.c:do_cpu_irq_mask) */
 163	.macro	extint code
 164	b	intr_extint
 165	mfsp    %sr7,%r16
 166	.align	32
 167	.endm	
 168
 169	.import	os_hpmc, code
 170
 171	/* HPMC handler */
 172	.macro	hpmc code
 173	nop			/* must be a NOP, will be patched later */
 174	load32	PA(os_hpmc), %r3
 175	bv,n	0(%r3)
 176	nop
 177	.word	0		/* checksum (will be patched) */
 178	.word	PA(os_hpmc)	/* address of handler */
 179	.word	0		/* length of handler */
 180	.endm
 181
 182	/*
 183	 * Performance Note: Instructions will be moved up into
 184	 * this part of the code later on, once we are sure
 185	 * that the tlb miss handlers are close to final form.
 186	 */
 187
 188	/* Register definitions for tlb miss handler macros */
 189
 190	va  = r8	/* virtual address for which the trap occurred */
 191	spc = r24	/* space for which the trap occurred */
 192
 193#ifndef CONFIG_64BIT
 194
 195	/*
 196	 * itlb miss interruption handler (parisc 1.1 - 32 bit)
 197	 */
 198
 199	.macro	itlb_11 code
 200
 201	mfctl	%pcsq, spc
 202	b	itlb_miss_11
 203	mfctl	%pcoq, va
 204
 205	.align		32
 206	.endm
 207#endif
 208	
 209	/*
 210	 * itlb miss interruption handler (parisc 2.0)
 211	 */
 212
 213	.macro	itlb_20 code
 214	mfctl	%pcsq, spc
 215#ifdef CONFIG_64BIT
 216	b       itlb_miss_20w
 217#else
 218	b	itlb_miss_20
 219#endif
 220	mfctl	%pcoq, va
 221
 222	.align		32
 223	.endm
 224	
 225#ifndef CONFIG_64BIT
 226	/*
 227	 * naitlb miss interruption handler (parisc 1.1 - 32 bit)
 228	 */
 229
 230	.macro	naitlb_11 code
 231
 232	mfctl	%isr,spc
 233	b	naitlb_miss_11
 234	mfctl 	%ior,va
 235
 236	.align		32
 237	.endm
 238#endif
 239	
 240	/*
 241	 * naitlb miss interruption handler (parisc 2.0)
 242	 */
 243
 244	.macro	naitlb_20 code
 245
 246	mfctl	%isr,spc
 247#ifdef CONFIG_64BIT
 248	b       naitlb_miss_20w
 249#else
 250	b	naitlb_miss_20
 251#endif
 252	mfctl 	%ior,va
 253
 254	.align		32
 255	.endm
 256	
 257#ifndef CONFIG_64BIT
 258	/*
 259	 * dtlb miss interruption handler (parisc 1.1 - 32 bit)
 260	 */
 261
 262	.macro	dtlb_11 code
 263
 264	mfctl	%isr, spc
 265	b	dtlb_miss_11
 266	mfctl	%ior, va
 267
 268	.align		32
 269	.endm
 270#endif
 271
 272	/*
 273	 * dtlb miss interruption handler (parisc 2.0)
 274	 */
 275
 276	.macro	dtlb_20 code
 277
 278	mfctl	%isr, spc
 279#ifdef CONFIG_64BIT
 280	b       dtlb_miss_20w
 281#else
 282	b	dtlb_miss_20
 283#endif
 284	mfctl	%ior, va
 285
 286	.align		32
 287	.endm
 288	
 289#ifndef CONFIG_64BIT
 290	/* nadtlb miss interruption handler (parisc 1.1 - 32 bit) */
 291
 292	.macro	nadtlb_11 code
 293
 294	mfctl	%isr,spc
 295	b       nadtlb_miss_11
 296	mfctl	%ior,va
 297
 298	.align		32
 299	.endm
 300#endif
 301	
 302	/* nadtlb miss interruption handler (parisc 2.0) */
 303
 304	.macro	nadtlb_20 code
 305
 306	mfctl	%isr,spc
 307#ifdef CONFIG_64BIT
 308	b       nadtlb_miss_20w
 309#else
 310	b       nadtlb_miss_20
 311#endif
 312	mfctl	%ior,va
 313
 314	.align		32
 315	.endm
 316	
 317#ifndef CONFIG_64BIT
 318	/*
 319	 * dirty bit trap interruption handler (parisc 1.1 - 32 bit)
 320	 */
 321
 322	.macro	dbit_11 code
 323
 324	mfctl	%isr,spc
 325	b	dbit_trap_11
 326	mfctl	%ior,va
 327
 328	.align		32
 329	.endm
 330#endif
 331
 332	/*
 333	 * dirty bit trap interruption handler (parisc 2.0)
 334	 */
 335
 336	.macro	dbit_20 code
 337
 338	mfctl	%isr,spc
 339#ifdef CONFIG_64BIT
 340	b       dbit_trap_20w
 341#else
 342	b	dbit_trap_20
 343#endif
 344	mfctl	%ior,va
 345
 346	.align		32
 347	.endm
 348
 349	/* In LP64, the space contains part of the upper 32 bits of the
 350	 * fault.  We have to extract this and place it in the va,
 351	 * zeroing the corresponding bits in the space register */
 352	.macro		space_adjust	spc,va,tmp
 353#ifdef CONFIG_64BIT
 354	extrd,u		\spc,63,SPACEID_SHIFT,\tmp
 355	depd		%r0,63,SPACEID_SHIFT,\spc
 356	depd		\tmp,31,SPACEID_SHIFT,\va
 357#endif
 358	.endm
 359
 360	.import		swapper_pg_dir,code
 361
 362	/* Get the pgd.  For faults on space zero (kernel space), this
 363	 * is simply swapper_pg_dir.  For user space faults, the
 364	 * pgd is stored in %cr25 */
 365	.macro		get_pgd		spc,reg
 366	ldil		L%PA(swapper_pg_dir),\reg
 367	ldo		R%PA(swapper_pg_dir)(\reg),\reg
 368	or,COND(=)	%r0,\spc,%r0
 369	mfctl		%cr25,\reg
 370	.endm
 371
 372	/* 
 373		space_check(spc,tmp,fault)
 374
 375		spc - The space we saw the fault with.
 376		tmp - The place to store the current space.
 377		fault - Function to call on failure.
 378
 379		Only allow faults on different spaces from the
 380		currently active one if we're the kernel 
 381
 382	*/
 383	.macro		space_check	spc,tmp,fault
 384	mfsp		%sr7,\tmp
 
 385	or,COND(<>)	%r0,\spc,%r0	/* user may execute gateway page
 386					 * as kernel, so defeat the space
 387					 * check if it is */
 388	copy		\spc,\tmp
 389	or,COND(=)	%r0,\tmp,%r0	/* nullify if executing as kernel */
 390	cmpb,COND(<>),n	\tmp,\spc,\fault
 391	.endm
 392
 393	/* Look up a PTE in a 2-Level scheme (faulting at each
 394	 * level if the entry isn't present 
 395	 *
 396	 * NOTE: we use ldw even for LP64, since the short pointers
 397	 * can address up to 1TB
 398	 */
 399	.macro		L2_ptep	pmd,pte,index,va,fault
 400#if PT_NLEVELS == 3
 401	extru		\va,31-ASM_PMD_SHIFT,ASM_BITS_PER_PMD,\index
 402#else
 403	extru		\va,31-ASM_PGDIR_SHIFT,ASM_BITS_PER_PGD,\index
 404#endif
 405	dep             %r0,31,PAGE_SHIFT,\pmd  /* clear offset */
 
 406	copy		%r0,\pte
 
 407	ldw,s		\index(\pmd),\pmd
 408	bb,>=,n		\pmd,_PxD_PRESENT_BIT,\fault
 409	dep		%r0,31,PxD_FLAG_SHIFT,\pmd /* clear flags */
 410	copy		\pmd,%r9
 411	SHLREG		%r9,PxD_VALUE_SHIFT,\pmd
 412	extru		\va,31-PAGE_SHIFT,ASM_BITS_PER_PTE,\index
 413	dep		%r0,31,PAGE_SHIFT,\pmd  /* clear offset */
 414	shladd		\index,BITS_PER_PTE_ENTRY,\pmd,\pmd
 415	LDREG		%r0(\pmd),\pte		/* pmd is now pte */
 416	bb,>=,n		\pte,_PAGE_PRESENT_BIT,\fault
 417	.endm
 418
 419	/* Look up PTE in a 3-Level scheme.
 420	 *
 421	 * Here we implement a Hybrid L2/L3 scheme: we allocate the
 422	 * first pmd adjacent to the pgd.  This means that we can
 423	 * subtract a constant offset to get to it.  The pmd and pgd
 424	 * sizes are arranged so that a single pmd covers 4GB (giving
 425	 * a full LP64 process access to 8TB) so our lookups are
 426	 * effectively L2 for the first 4GB of the kernel (i.e. for
 427	 * all ILP32 processes and all the kernel for machines with
 428	 * under 4GB of memory) */
 429	.macro		L3_ptep pgd,pte,index,va,fault
 430#if PT_NLEVELS == 3 /* we might have a 2-Level scheme, e.g. with 16kb page size */
 
 431	extrd,u		\va,63-ASM_PGDIR_SHIFT,ASM_BITS_PER_PGD,\index
 432	copy		%r0,\pte
 433	extrd,u,*=	\va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0
 434	ldw,s		\index(\pgd),\pgd
 435	extrd,u,*=	\va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0
 436	bb,>=,n		\pgd,_PxD_PRESENT_BIT,\fault
 437	extrd,u,*=	\va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0
 438	shld		\pgd,PxD_VALUE_SHIFT,\index
 439	extrd,u,*=	\va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0
 440	copy		\index,\pgd
 441	extrd,u,*<>	\va,63-ASM_PGDIR_SHIFT,64-ASM_PGDIR_SHIFT,%r0
 442	ldo		ASM_PGD_PMD_OFFSET(\pgd),\pgd
 443#endif
 444	L2_ptep		\pgd,\pte,\index,\va,\fault
 445	.endm
 446
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 447	/* Set the _PAGE_ACCESSED bit of the PTE.  Be clever and
 448	 * don't needlessly dirty the cache line if it was already set */
 449	.macro		update_ptep	ptep,pte,tmp,tmp1
 450	ldi		_PAGE_ACCESSED,\tmp1
 451	or		\tmp1,\pte,\tmp
 452	and,COND(<>)	\tmp1,\pte,%r0
 453	STREG		\tmp,0(\ptep)
 454	.endm
 455
 456	/* Set the dirty bit (and accessed bit).  No need to be
 457	 * clever, this is only used from the dirty fault */
 458	.macro		update_dirty	ptep,pte,tmp
 459	ldi		_PAGE_ACCESSED|_PAGE_DIRTY,\tmp
 460	or		\tmp,\pte,\pte
 461	STREG		\pte,0(\ptep)
 462	.endm
 463
 
 
 
 
 464	/* bitshift difference between a PFN (based on kernel's PAGE_SIZE)
 465	 * to a CPU TLB 4k PFN (4k => 12 bits to shift) */
 466	#define PAGE_ADD_SHIFT  (PAGE_SHIFT-12)
 
 
 467
 468	/* Drop prot bits and convert to page addr for iitlbt and idtlbt */
 469	.macro		convert_for_tlb_insert20 pte
 470	extrd,u		\pte,(63-ASM_PFN_PTE_SHIFT)+(63-58)+PAGE_ADD_SHIFT,\
 471				64-PAGE_SHIFT-PAGE_ADD_SHIFT,\pte
 
 
 472	depdi		_PAGE_SIZE_ENCODING_DEFAULT,63,\
 473				(63-58)+PAGE_ADD_SHIFT,\pte
 
 
 
 
 
 
 
 
 474	.endm
 475
 476	/* Convert the pte and prot to tlb insertion values.  How
 477	 * this happens is quite subtle, read below */
 478	.macro		make_insert_tlb	spc,pte,prot
 479	space_to_prot   \spc \prot        /* create prot id from space */
 480	/* The following is the real subtlety.  This is depositing
 481	 * T <-> _PAGE_REFTRAP
 482	 * D <-> _PAGE_DIRTY
 483	 * B <-> _PAGE_DMB (memory break)
 484	 *
 485	 * Then incredible subtlety: The access rights are
 486	 * _PAGE_GATEWAY _PAGE_EXEC _PAGE_READ
 487	 * See 3-14 of the parisc 2.0 manual
 488	 *
 489	 * Finally, _PAGE_READ goes in the top bit of PL1 (so we
 490	 * trigger an access rights trap in user space if the user
 491	 * tries to read an unreadable page */
 
 
 
 
 492	depd            \pte,8,7,\prot
 493
 494	/* PAGE_USER indicates the page can be read with user privileges,
 495	 * so deposit X1|11 to PL1|PL2 (remember the upper bit of PL1
 496	 * contains _PAGE_READ */
 497	extrd,u,*=      \pte,_PAGE_USER_BIT+32,1,%r0
 498	depdi		7,11,3,\prot
 499	/* If we're a gateway page, drop PL2 back to zero for promotion
 500	 * to kernel privilege (so we can execute the page as kernel).
 501	 * Any privilege promotion page always denys read and write */
 502	extrd,u,*= 	\pte,_PAGE_GATEWAY_BIT+32,1,%r0
 503	depd		%r0,11,2,\prot	/* If Gateway, Set PL2 to 0 */
 504
 505	/* Enforce uncacheable pages.
 506	 * This should ONLY be use for MMIO on PA 2.0 machines.
 507	 * Memory/DMA is cache coherent on all PA2.0 machines we support
 508	 * (that means T-class is NOT supported) and the memory controllers
 509	 * on most of those machines only handles cache transactions.
 510	 */
 511	extrd,u,*=	\pte,_PAGE_NO_CACHE_BIT+32,1,%r0
 512	depdi		1,12,1,\prot
 513
 514	/* Drop prot bits and convert to page addr for iitlbt and idtlbt */
 515	convert_for_tlb_insert20 \pte
 516	.endm
 517
 518	/* Identical macro to make_insert_tlb above, except it
 519	 * makes the tlb entry for the differently formatted pa11
 520	 * insertion instructions */
 521	.macro		make_insert_tlb_11	spc,pte,prot
 
 
 
 
 522	zdep		\spc,30,15,\prot
 523	dep		\pte,8,7,\prot
 524	extru,=		\pte,_PAGE_NO_CACHE_BIT,1,%r0
 525	depi		1,12,1,\prot
 526	extru,=         \pte,_PAGE_USER_BIT,1,%r0
 527	depi		7,11,3,\prot   /* Set for user space (1 rsvd for read) */
 528	extru,= 	\pte,_PAGE_GATEWAY_BIT,1,%r0
 529	depi		0,11,2,\prot	/* If Gateway, Set PL2 to 0 */
 530
 531	/* Get rid of prot bits and convert to page addr for iitlba */
 532
 533	depi		0,31,ASM_PFN_PTE_SHIFT,\pte
 534	SHRREG		\pte,(ASM_PFN_PTE_SHIFT-(31-26)),\pte
 535	.endm
 536
 537	/* This is for ILP32 PA2.0 only.  The TLB insertion needs
 538	 * to extend into I/O space if the address is 0xfXXXXXXX
 539	 * so we extend the f's into the top word of the pte in
 540	 * this case */
 541	.macro		f_extend	pte,tmp
 542	extrd,s		\pte,42,4,\tmp
 543	addi,<>		1,\tmp,%r0
 544	extrd,s		\pte,63,25,\pte
 545	.endm
 546
 547	/* The alias region is an 8MB aligned 16MB to do clear and
 548	 * copy user pages at addresses congruent with the user
 
 549	 * virtual address.
 550	 *
 551	 * To use the alias page, you set %r26 up with the to TLB
 552	 * entry (identifying the physical page) and %r23 up with
 553	 * the from tlb entry (or nothing if only a to entry---for
 554	 * clear_user_page_asm) */
 555	.macro		do_alias	spc,tmp,tmp1,va,pte,prot,fault,patype
 556	cmpib,COND(<>),n 0,\spc,\fault
 557	ldil		L%(TMPALIAS_MAP_START),\tmp
 558#if defined(CONFIG_64BIT) && (TMPALIAS_MAP_START >= 0x80000000)
 559	/* on LP64, ldi will sign extend into the upper 32 bits,
 560	 * which is behaviour we don't want */
 561	depdi		0,31,32,\tmp
 562#endif
 563	copy		\va,\tmp1
 564	depi		0,31,23,\tmp1
 565	cmpb,COND(<>),n	\tmp,\tmp1,\fault
 566	mfctl		%cr19,\tmp	/* iir */
 567	/* get the opcode (first six bits) into \tmp */
 568	extrw,u		\tmp,5,6,\tmp
 569	/*
 570	 * Only setting the T bit prevents data cache movein
 571	 * Setting access rights to zero prevents instruction cache movein
 572	 *
 573	 * Note subtlety here: _PAGE_GATEWAY, _PAGE_EXEC and _PAGE_WRITE go
 574	 * to type field and _PAGE_READ goes to top bit of PL1
 575	 */
 576	ldi		(_PAGE_REFTRAP|_PAGE_READ|_PAGE_WRITE),\prot
 577	/*
 578	 * so if the opcode is one (i.e. this is a memory management
 579	 * instruction) nullify the next load so \prot is only T.
 580	 * Otherwise this is a normal data operation
 581	 */
 582	cmpiclr,=	0x01,\tmp,%r0
 583	ldi		(_PAGE_DIRTY|_PAGE_READ|_PAGE_WRITE),\prot
 584.ifc \patype,20
 585	depd,z		\prot,8,7,\prot
 586.else
 587.ifc \patype,11
 588	depw,z		\prot,8,7,\prot
 589.else
 590	.error "undefined PA type to do_alias"
 591.endif
 592.endif
 593	/*
 594	 * OK, it is in the temp alias region, check whether "from" or "to".
 595	 * Check "subtle" note in pacache.S re: r23/r26.
 596	 */
 597#ifdef CONFIG_64BIT
 598	extrd,u,*=	\va,41,1,%r0
 599#else
 600	extrw,u,=	\va,9,1,%r0
 601#endif
 602	or,COND(tr)	%r23,%r0,\pte
 603	or		%r26,%r0,\pte
 
 
 
 
 604	.endm 
 605
 606
 607	/*
 608	 * Align fault_vector_20 on 4K boundary so that both
 609	 * fault_vector_11 and fault_vector_20 are on the
 610	 * same page. This is only necessary as long as we
 611	 * write protect the kernel text, which we may stop
 612	 * doing once we use large page translations to cover
 613	 * the static part of the kernel address space.
 614	 */
 615
 616	.text
 617
 618	.align	PAGE_SIZE
 619
 620ENTRY(fault_vector_20)
 621	/* First vector is invalid (0) */
 622	.ascii	"cows can fly"
 623	.byte 0
 624	.align 32
 625
 626	hpmc		 1
 627	def		 2
 628	def		 3
 629	extint		 4
 630	def		 5
 631	itlb_20		 6
 632	def		 7
 633	def		 8
 634	def              9
 635	def		10
 636	def		11
 637	def		12
 638	def		13
 639	def		14
 640	dtlb_20		15
 641	naitlb_20	16
 642	nadtlb_20	17
 643	def		18
 644	def		19
 645	dbit_20		20
 646	def		21
 647	def		22
 648	def		23
 649	def		24
 650	def		25
 651	def		26
 652	def		27
 653	def		28
 654	def		29
 655	def		30
 656	def		31
 657END(fault_vector_20)
 658
 659#ifndef CONFIG_64BIT
 660
 661	.align 2048
 662
 663ENTRY(fault_vector_11)
 664	/* First vector is invalid (0) */
 665	.ascii	"cows can fly"
 666	.byte 0
 667	.align 32
 668
 669	hpmc		 1
 670	def		 2
 671	def		 3
 672	extint		 4
 673	def		 5
 674	itlb_11		 6
 675	def		 7
 676	def		 8
 677	def              9
 678	def		10
 679	def		11
 680	def		12
 681	def		13
 682	def		14
 683	dtlb_11		15
 684	naitlb_11	16
 685	nadtlb_11	17
 686	def		18
 687	def		19
 688	dbit_11		20
 689	def		21
 690	def		22
 691	def		23
 692	def		24
 693	def		25
 694	def		26
 695	def		27
 696	def		28
 697	def		29
 698	def		30
 699	def		31
 700END(fault_vector_11)
 701
 702#endif
 703	/* Fault vector is separately protected and *must* be on its own page */
 704	.align		PAGE_SIZE
 705ENTRY(end_fault_vector)
 706
 707	.import		handle_interruption,code
 708	.import		do_cpu_irq_mask,code
 709
 710	/*
 711	 * r26 = function to be called
 712	 * r25 = argument to pass in
 713	 * r24 = flags for do_fork()
 714	 *
 715	 * Kernel threads don't ever return, so they don't need
 716	 * a true register context. We just save away the arguments
 717	 * for copy_thread/ret_ to properly set up the child.
 718	 */
 719
 720#define CLONE_VM 0x100	/* Must agree with <linux/sched.h> */
 721#define CLONE_UNTRACED 0x00800000
 722
 723	.import do_fork
 724ENTRY(__kernel_thread)
 725	STREG	%r2, -RP_OFFSET(%r30)
 726
 727	copy	%r30, %r1
 728	ldo	PT_SZ_ALGN(%r30),%r30
 729#ifdef CONFIG_64BIT
 730	/* Yo, function pointers in wide mode are little structs... -PB */
 731	ldd	24(%r26), %r2
 732	STREG	%r2, PT_GR27(%r1)	/* Store childs %dp */
 733	ldd	16(%r26), %r26
 734
 735	STREG	%r22, PT_GR22(%r1)	/* save r22 (arg5) */
 736	copy	%r0, %r22		/* user_tid */
 737#endif
 738	STREG	%r26, PT_GR26(%r1)  /* Store function & argument for child */
 739	STREG	%r25, PT_GR25(%r1)
 740	ldil	L%CLONE_UNTRACED, %r26
 741	ldo	CLONE_VM(%r26), %r26   /* Force CLONE_VM since only init_mm */
 742	or	%r26, %r24, %r26      /* will have kernel mappings.	 */
 743	ldi	1, %r25			/* stack_start, signals kernel thread */
 744	stw	%r0, -52(%r30)	     	/* user_tid */
 745#ifdef CONFIG_64BIT
 746	ldo	-16(%r30),%r29		/* Reference param save area */
 747#endif
 748	BL	do_fork, %r2
 749	copy	%r1, %r24		/* pt_regs */
 750
 751	/* Parent Returns here */
 752
 753	LDREG	-PT_SZ_ALGN-RP_OFFSET(%r30), %r2
 754	ldo	-PT_SZ_ALGN(%r30), %r30
 755	bv	%r0(%r2)
 756	nop
 757ENDPROC(__kernel_thread)
 758
 759	/*
 760	 * Child Returns here
 761	 *
 762	 * copy_thread moved args from temp save area set up above
 763	 * into task save area.
 764	 */
 765
 766ENTRY(ret_from_kernel_thread)
 767
 768	/* Call schedule_tail first though */
 769	BL	schedule_tail, %r2
 770	nop
 771
 772	LDREG	TI_TASK-THREAD_SZ_ALGN(%r30), %r1
 773	LDREG	TASK_PT_GR25(%r1), %r26
 774#ifdef CONFIG_64BIT
 775	LDREG	TASK_PT_GR27(%r1), %r27
 776	LDREG	TASK_PT_GR22(%r1), %r22
 777#endif
 778	LDREG	TASK_PT_GR26(%r1), %r1
 779	ble	0(%sr7, %r1)
 780	copy	%r31, %r2
 781
 782#ifdef CONFIG_64BIT
 783	ldo	-16(%r30),%r29		/* Reference param save area */
 784	loadgp				/* Thread could have been in a module */
 785#endif
 786#ifndef CONFIG_64BIT
 787	b	sys_exit
 788#else
 789	load32	sys_exit, %r1
 790	bv	%r0(%r1)
 791#endif
 792	ldi	0, %r26
 793ENDPROC(ret_from_kernel_thread)
 794
 795	.import	sys_execve, code
 796ENTRY(__execve)
 797	copy	%r2, %r15
 798	copy	%r30, %r16
 799	ldo	PT_SZ_ALGN(%r30), %r30
 800	STREG	%r26, PT_GR26(%r16)
 801	STREG	%r25, PT_GR25(%r16)
 802	STREG	%r24, PT_GR24(%r16)
 803#ifdef CONFIG_64BIT
 804	ldo	-16(%r30),%r29		/* Reference param save area */
 805#endif
 806	BL	sys_execve, %r2
 807	copy	%r16, %r26
 808
 809	cmpib,=,n 0,%r28,intr_return    /* forward */
 810
 811	/* yes, this will trap and die. */
 812	copy	%r15, %r2
 813	copy	%r16, %r30
 814	bv	%r0(%r2)
 815	nop
 816ENDPROC(__execve)
 817
 818
 819	/*
 820	 * struct task_struct *_switch_to(struct task_struct *prev,
 821	 *	struct task_struct *next)
 822	 *
 823	 * switch kernel stacks and return prev */
 824ENTRY(_switch_to)
 825	STREG	 %r2, -RP_OFFSET(%r30)
 826
 827	callee_save_float
 828	callee_save
 829
 830	load32	_switch_to_ret, %r2
 831
 832	STREG	%r2, TASK_PT_KPC(%r26)
 833	LDREG	TASK_PT_KPC(%r25), %r2
 834
 835	STREG	%r30, TASK_PT_KSP(%r26)
 836	LDREG	TASK_PT_KSP(%r25), %r30
 837	LDREG	TASK_THREAD_INFO(%r25), %r25
 838	bv	%r0(%r2)
 839	mtctl   %r25,%cr30
 840
 841_switch_to_ret:
 842	mtctl	%r0, %cr0		/* Needed for single stepping */
 843	callee_rest
 844	callee_rest_float
 845
 846	LDREG	-RP_OFFSET(%r30), %r2
 847	bv	%r0(%r2)
 848	copy	%r26, %r28
 849ENDPROC(_switch_to)
 850
 851	/*
 852	 * Common rfi return path for interruptions, kernel execve, and
 853	 * sys_rt_sigreturn (sometimes).  The sys_rt_sigreturn syscall will
 854	 * return via this path if the signal was received when the process
 855	 * was running; if the process was blocked on a syscall then the
 856	 * normal syscall_exit path is used.  All syscalls for traced
 857	 * proceses exit via intr_restore.
 858	 *
 859	 * XXX If any syscalls that change a processes space id ever exit
 860	 * this way, then we will need to copy %sr3 in to PT_SR[3..7], and
 861	 * adjust IASQ[0..1].
 862	 *
 863	 */
 864
 865	.align	PAGE_SIZE
 866
 867ENTRY(syscall_exit_rfi)
 868	mfctl   %cr30,%r16
 869	LDREG	TI_TASK(%r16), %r16	/* thread_info -> task_struct */
 870	ldo	TASK_REGS(%r16),%r16
 871	/* Force iaoq to userspace, as the user has had access to our current
 872	 * context via sigcontext. Also Filter the PSW for the same reason.
 873	 */
 874	LDREG	PT_IAOQ0(%r16),%r19
 875	depi	3,31,2,%r19
 876	STREG	%r19,PT_IAOQ0(%r16)
 877	LDREG	PT_IAOQ1(%r16),%r19
 878	depi	3,31,2,%r19
 879	STREG	%r19,PT_IAOQ1(%r16)
 880	LDREG   PT_PSW(%r16),%r19
 881	load32	USER_PSW_MASK,%r1
 882#ifdef CONFIG_64BIT
 883	load32	USER_PSW_HI_MASK,%r20
 884	depd    %r20,31,32,%r1
 885#endif
 886	and     %r19,%r1,%r19 /* Mask out bits that user shouldn't play with */
 887	load32	USER_PSW,%r1
 888	or      %r19,%r1,%r19 /* Make sure default USER_PSW bits are set */
 889	STREG   %r19,PT_PSW(%r16)
 890
 891	/*
 892	 * If we aren't being traced, we never saved space registers
 893	 * (we don't store them in the sigcontext), so set them
 894	 * to "proper" values now (otherwise we'll wind up restoring
 895	 * whatever was last stored in the task structure, which might
 896	 * be inconsistent if an interrupt occurred while on the gateway
 897	 * page). Note that we may be "trashing" values the user put in
 898	 * them, but we don't support the user changing them.
 899	 */
 900
 901	STREG   %r0,PT_SR2(%r16)
 902	mfsp    %sr3,%r19
 903	STREG   %r19,PT_SR0(%r16)
 904	STREG   %r19,PT_SR1(%r16)
 905	STREG   %r19,PT_SR3(%r16)
 906	STREG   %r19,PT_SR4(%r16)
 907	STREG   %r19,PT_SR5(%r16)
 908	STREG   %r19,PT_SR6(%r16)
 909	STREG   %r19,PT_SR7(%r16)
 910
 911intr_return:
 912	/* NOTE: Need to enable interrupts incase we schedule. */
 913	ssm     PSW_SM_I, %r0
 914
 915intr_check_resched:
 916
 917	/* check for reschedule */
 918	mfctl   %cr30,%r1
 919	LDREG   TI_FLAGS(%r1),%r19	/* sched.h: TIF_NEED_RESCHED */
 920	bb,<,n	%r19,31-TIF_NEED_RESCHED,intr_do_resched /* forward */
 921
 922	.import do_notify_resume,code
 923intr_check_sig:
 924	/* As above */
 925	mfctl   %cr30,%r1
 926	LDREG	TI_FLAGS(%r1),%r19
 927	ldi	(_TIF_SIGPENDING|_TIF_NOTIFY_RESUME), %r20
 928	and,COND(<>)	%r19, %r20, %r0
 929	b,n	intr_restore	/* skip past if we've nothing to do */
 930
 931	/* This check is critical to having LWS
 932	 * working. The IASQ is zero on the gateway
 933	 * page and we cannot deliver any signals until
 934	 * we get off the gateway page.
 935	 *
 936	 * Only do signals if we are returning to user space
 937	 */
 938	LDREG	PT_IASQ0(%r16), %r20
 939	cmpib,COND(=),n 0,%r20,intr_restore /* backward */
 940	LDREG	PT_IASQ1(%r16), %r20
 941	cmpib,COND(=),n 0,%r20,intr_restore /* backward */
 942
 943	copy	%r0, %r25			/* long in_syscall = 0 */
 944#ifdef CONFIG_64BIT
 945	ldo	-16(%r30),%r29			/* Reference param save area */
 946#endif
 947
 
 
 
 
 
 948	BL	do_notify_resume,%r2
 949	copy	%r16, %r26			/* struct pt_regs *regs */
 950
 951	b,n	intr_check_sig
 952
 953intr_restore:
 954	copy            %r16,%r29
 955	ldo             PT_FR31(%r29),%r1
 956	rest_fp         %r1
 957	rest_general    %r29
 958
 959	/* inverse of virt_map */
 960	pcxt_ssm_bug
 961	rsm             PSW_SM_QUIET,%r0	/* prepare for rfi */
 962	tophys_r1       %r29
 963
 964	/* Restore space id's and special cr's from PT_REGS
 965	 * structure pointed to by r29
 966	 */
 967	rest_specials	%r29
 968
 969	/* IMPORTANT: rest_stack restores r29 last (we are using it)!
 970	 * It also restores r1 and r30.
 971	 */
 972	rest_stack
 973
 974	rfi
 975	nop
 976
 977#ifndef CONFIG_PREEMPT
 978# define intr_do_preempt	intr_restore
 979#endif /* !CONFIG_PREEMPT */
 980
 981	.import schedule,code
 982intr_do_resched:
 983	/* Only call schedule on return to userspace. If we're returning
 984	 * to kernel space, we may schedule if CONFIG_PREEMPT, otherwise
 985	 * we jump back to intr_restore.
 986	 */
 987	LDREG	PT_IASQ0(%r16), %r20
 988	cmpib,COND(=)	0, %r20, intr_do_preempt
 989	nop
 990	LDREG	PT_IASQ1(%r16), %r20
 991	cmpib,COND(=)	0, %r20, intr_do_preempt
 992	nop
 993
 
 
 
 
 994#ifdef CONFIG_64BIT
 995	ldo	-16(%r30),%r29		/* Reference param save area */
 996#endif
 997
 998	ldil	L%intr_check_sig, %r2
 999#ifndef CONFIG_64BIT
1000	b	schedule
1001#else
1002	load32	schedule, %r20
1003	bv	%r0(%r20)
1004#endif
1005	ldo	R%intr_check_sig(%r2), %r2
1006
1007	/* preempt the current task on returning to kernel
1008	 * mode from an interrupt, iff need_resched is set,
1009	 * and preempt_count is 0. otherwise, we continue on
1010	 * our merry way back to the current running task.
1011	 */
1012#ifdef CONFIG_PREEMPT
1013	.import preempt_schedule_irq,code
1014intr_do_preempt:
1015	rsm	PSW_SM_I, %r0		/* disable interrupts */
1016
1017	/* current_thread_info()->preempt_count */
1018	mfctl	%cr30, %r1
1019	LDREG	TI_PRE_COUNT(%r1), %r19
1020	cmpib,COND(<>)	0, %r19, intr_restore	/* if preempt_count > 0 */
1021	nop				/* prev insn branched backwards */
1022
1023	/* check if we interrupted a critical path */
1024	LDREG	PT_PSW(%r16), %r20
1025	bb,<,n	%r20, 31 - PSW_SM_I, intr_restore
1026	nop
1027
 
 
 
 
 
 
 
 
1028	BL	preempt_schedule_irq, %r2
1029	nop
1030
1031	b,n	intr_restore		/* ssm PSW_SM_I done by intr_restore */
1032#endif /* CONFIG_PREEMPT */
1033
1034	/*
1035	 * External interrupts.
1036	 */
1037
1038intr_extint:
1039	cmpib,COND(=),n 0,%r16,1f
1040
1041	get_stack_use_cr30
1042	b,n 2f
1043
10441:
1045	get_stack_use_r30
10462:
1047	save_specials	%r29
1048	virt_map
1049	save_general	%r29
1050
1051	ldo	PT_FR0(%r29), %r24
1052	save_fp	%r24
1053	
1054	loadgp
1055
1056	copy	%r29, %r26	/* arg0 is pt_regs */
1057	copy	%r29, %r16	/* save pt_regs */
1058
1059	ldil	L%intr_return, %r2
1060
1061#ifdef CONFIG_64BIT
1062	ldo	-16(%r30),%r29	/* Reference param save area */
1063#endif
1064
1065	b	do_cpu_irq_mask
1066	ldo	R%intr_return(%r2), %r2	/* return to intr_return, not here */
1067ENDPROC(syscall_exit_rfi)
1068
1069
1070	/* Generic interruptions (illegal insn, unaligned, page fault, etc) */
1071
1072ENTRY(intr_save)		/* for os_hpmc */
1073	mfsp    %sr7,%r16
1074	cmpib,COND(=),n 0,%r16,1f
1075	get_stack_use_cr30
1076	b	2f
1077	copy    %r8,%r26
1078
10791:
1080	get_stack_use_r30
1081	copy    %r8,%r26
1082
10832:
1084	save_specials	%r29
1085
1086	/* If this trap is a itlb miss, skip saving/adjusting isr/ior */
1087
1088	/*
1089	 * FIXME: 1) Use a #define for the hardwired "6" below (and in
1090	 *           traps.c.
1091	 *        2) Once we start executing code above 4 Gb, we need
1092	 *           to adjust iasq/iaoq here in the same way we
1093	 *           adjust isr/ior below.
1094	 */
1095
1096	cmpib,COND(=),n        6,%r26,skip_save_ior
1097
1098
1099	mfctl           %cr20, %r16 /* isr */
1100	nop		/* serialize mfctl on PA 2.0 to avoid 4 cycle penalty */
1101	mfctl           %cr21, %r17 /* ior */
1102
1103
1104#ifdef CONFIG_64BIT
1105	/*
1106	 * If the interrupted code was running with W bit off (32 bit),
1107	 * clear the b bits (bits 0 & 1) in the ior.
1108	 * save_specials left ipsw value in r8 for us to test.
1109	 */
1110	extrd,u,*<>     %r8,PSW_W_BIT,1,%r0
1111	depdi           0,1,2,%r17
1112
1113	/*
1114	 * FIXME: This code has hardwired assumptions about the split
1115	 *        between space bits and offset bits. This will change
1116	 *        when we allow alternate page sizes.
1117	 */
1118
1119	/* adjust isr/ior. */
1120	extrd,u         %r16,63,SPACEID_SHIFT,%r1	/* get high bits from isr for ior */
1121	depd            %r1,31,SPACEID_SHIFT,%r17	/* deposit them into ior */
1122	depdi           0,63,SPACEID_SHIFT,%r16		/* clear them from isr */
1123#endif
1124	STREG           %r16, PT_ISR(%r29)
1125	STREG           %r17, PT_IOR(%r29)
1126
 
 
1127
1128skip_save_ior:
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1129	virt_map
1130	save_general	%r29
1131
1132	ldo		PT_FR0(%r29), %r25
1133	save_fp		%r25
1134	
1135	loadgp
1136
1137	copy		%r29, %r25	/* arg1 is pt_regs */
1138#ifdef CONFIG_64BIT
1139	ldo		-16(%r30),%r29	/* Reference param save area */
1140#endif
1141
1142	ldil		L%intr_check_sig, %r2
1143	copy		%r25, %r16	/* save pt_regs */
1144
1145	b		handle_interruption
1146	ldo		R%intr_check_sig(%r2), %r2
1147ENDPROC(intr_save)
1148
1149
1150	/*
1151	 * Note for all tlb miss handlers:
1152	 *
1153	 * cr24 contains a pointer to the kernel address space
1154	 * page directory.
1155	 *
1156	 * cr25 contains a pointer to the current user address
1157	 * space page directory.
1158	 *
1159	 * sr3 will contain the space id of the user address space
1160	 * of the current running thread while that thread is
1161	 * running in the kernel.
1162	 */
1163
1164	/*
1165	 * register number allocations.  Note that these are all
1166	 * in the shadowed registers
1167	 */
1168
1169	t0 = r1		/* temporary register 0 */
1170	va = r8		/* virtual address for which the trap occurred */
1171	t1 = r9		/* temporary register 1 */
1172	pte  = r16	/* pte/phys page # */
1173	prot = r17	/* prot bits */
1174	spc  = r24	/* space for which the trap occurred */
1175	ptp = r25	/* page directory/page table pointer */
1176
1177#ifdef CONFIG_64BIT
1178
1179dtlb_miss_20w:
1180	space_adjust	spc,va,t0
1181	get_pgd		spc,ptp
1182	space_check	spc,t0,dtlb_fault
1183
1184	L3_ptep		ptp,pte,t0,va,dtlb_check_alias_20w
1185
1186	update_ptep	ptp,pte,t0,t1
 
1187
1188	make_insert_tlb	spc,pte,prot
1189	
1190	idtlbt          pte,prot
1191
 
1192	rfir
1193	nop
1194
1195dtlb_check_alias_20w:
1196	do_alias	spc,t0,t1,va,pte,prot,dtlb_fault,20
1197
1198	idtlbt          pte,prot
1199
 
1200	rfir
1201	nop
1202
1203nadtlb_miss_20w:
1204	space_adjust	spc,va,t0
1205	get_pgd		spc,ptp
1206	space_check	spc,t0,nadtlb_fault
1207
1208	L3_ptep		ptp,pte,t0,va,nadtlb_check_alias_20w
1209
1210	update_ptep	ptp,pte,t0,t1
 
1211
1212	make_insert_tlb	spc,pte,prot
1213
1214	idtlbt          pte,prot
1215
 
1216	rfir
1217	nop
1218
1219nadtlb_check_alias_20w:
1220	do_alias	spc,t0,t1,va,pte,prot,nadtlb_emulate,20
1221
1222	idtlbt          pte,prot
1223
 
1224	rfir
1225	nop
1226
1227#else
1228
1229dtlb_miss_11:
1230	get_pgd		spc,ptp
1231
1232	space_check	spc,t0,dtlb_fault
1233
1234	L2_ptep		ptp,pte,t0,va,dtlb_check_alias_11
1235
1236	update_ptep	ptp,pte,t0,t1
 
1237
1238	make_insert_tlb_11	spc,pte,prot
1239
1240	mfsp		%sr1,t0  /* Save sr1 so we can use it in tlb inserts */
1241	mtsp		spc,%sr1
1242
1243	idtlba		pte,(%sr1,va)
1244	idtlbp		prot,(%sr1,va)
1245
1246	mtsp		t0, %sr1	/* Restore sr1 */
1247
 
1248	rfir
1249	nop
1250
1251dtlb_check_alias_11:
1252	do_alias	spc,t0,t1,va,pte,prot,dtlb_fault,11
1253
1254	idtlba          pte,(va)
1255	idtlbp          prot,(va)
1256
 
1257	rfir
1258	nop
1259
1260nadtlb_miss_11:
1261	get_pgd		spc,ptp
1262
1263	space_check	spc,t0,nadtlb_fault
1264
1265	L2_ptep		ptp,pte,t0,va,nadtlb_check_alias_11
1266
1267	update_ptep	ptp,pte,t0,t1
 
1268
1269	make_insert_tlb_11	spc,pte,prot
1270
1271
1272	mfsp		%sr1,t0  /* Save sr1 so we can use it in tlb inserts */
1273	mtsp		spc,%sr1
1274
1275	idtlba		pte,(%sr1,va)
1276	idtlbp		prot,(%sr1,va)
1277
1278	mtsp		t0, %sr1	/* Restore sr1 */
1279
 
1280	rfir
1281	nop
1282
1283nadtlb_check_alias_11:
1284	do_alias	spc,t0,t1,va,pte,prot,nadtlb_emulate,11
1285
1286	idtlba          pte,(va)
1287	idtlbp          prot,(va)
1288
 
1289	rfir
1290	nop
1291
1292dtlb_miss_20:
1293	space_adjust	spc,va,t0
1294	get_pgd		spc,ptp
1295	space_check	spc,t0,dtlb_fault
1296
1297	L2_ptep		ptp,pte,t0,va,dtlb_check_alias_20
1298
1299	update_ptep	ptp,pte,t0,t1
 
1300
1301	make_insert_tlb	spc,pte,prot
1302
1303	f_extend	pte,t0
1304
1305	idtlbt          pte,prot
1306
 
1307	rfir
1308	nop
1309
1310dtlb_check_alias_20:
1311	do_alias	spc,t0,t1,va,pte,prot,dtlb_fault,20
1312	
1313	idtlbt          pte,prot
1314
 
1315	rfir
1316	nop
1317
1318nadtlb_miss_20:
1319	get_pgd		spc,ptp
1320
1321	space_check	spc,t0,nadtlb_fault
1322
1323	L2_ptep		ptp,pte,t0,va,nadtlb_check_alias_20
1324
1325	update_ptep	ptp,pte,t0,t1
 
1326
1327	make_insert_tlb	spc,pte,prot
1328
1329	f_extend	pte,t0
1330	
1331        idtlbt          pte,prot
1332
 
1333	rfir
1334	nop
1335
1336nadtlb_check_alias_20:
1337	do_alias	spc,t0,t1,va,pte,prot,nadtlb_emulate,20
1338
1339	idtlbt          pte,prot
1340
 
1341	rfir
1342	nop
1343
1344#endif
1345
1346nadtlb_emulate:
1347
1348	/*
1349	 * Non access misses can be caused by fdc,fic,pdc,lpa,probe and
1350	 * probei instructions. We don't want to fault for these
1351	 * instructions (not only does it not make sense, it can cause
1352	 * deadlocks, since some flushes are done with the mmap
1353	 * semaphore held). If the translation doesn't exist, we can't
1354	 * insert a translation, so have to emulate the side effects
1355	 * of the instruction. Since we don't insert a translation
1356	 * we can get a lot of faults during a flush loop, so it makes
1357	 * sense to try to do it here with minimum overhead. We only
1358	 * emulate fdc,fic,pdc,probew,prober instructions whose base 
1359	 * and index registers are not shadowed. We defer everything 
1360	 * else to the "slow" path.
1361	 */
1362
1363	mfctl           %cr19,%r9 /* Get iir */
1364
1365	/* PA 2.0 Arch Ref. Book pg 382 has a good description of the insn bits.
1366	   Checks for fdc,fdce,pdc,"fic,4f",prober,probeir,probew, probeiw */
1367
1368	/* Checks for fdc,fdce,pdc,"fic,4f" only */
1369	ldi             0x280,%r16
1370	and             %r9,%r16,%r17
1371	cmpb,<>,n       %r16,%r17,nadtlb_probe_check
1372	bb,>=,n         %r9,26,nadtlb_nullify  /* m bit not set, just nullify */
1373	BL		get_register,%r25
1374	extrw,u         %r9,15,5,%r8           /* Get index register # */
1375	cmpib,COND(=),n        -1,%r1,nadtlb_fault    /* have to use slow path */
1376	copy            %r1,%r24
1377	BL		get_register,%r25
1378	extrw,u         %r9,10,5,%r8           /* Get base register # */
1379	cmpib,COND(=),n        -1,%r1,nadtlb_fault    /* have to use slow path */
1380	BL		set_register,%r25
1381	add,l           %r1,%r24,%r1           /* doesn't affect c/b bits */
1382
1383nadtlb_nullify:
1384	mfctl           %ipsw,%r8
1385	ldil            L%PSW_N,%r9
1386	or              %r8,%r9,%r8            /* Set PSW_N */
1387	mtctl           %r8,%ipsw
1388
1389	rfir
1390	nop
1391
1392	/* 
1393		When there is no translation for the probe address then we
1394		must nullify the insn and return zero in the target regsiter.
1395		This will indicate to the calling code that it does not have 
1396		write/read privileges to this address.
1397
1398		This should technically work for prober and probew in PA 1.1,
1399		and also probe,r and probe,w in PA 2.0
1400
1401		WARNING: USE ONLY NON-SHADOW REGISTERS WITH PROBE INSN!
1402		THE SLOW-PATH EMULATION HAS NOT BEEN WRITTEN YET.
1403
1404	*/
1405nadtlb_probe_check:
1406	ldi             0x80,%r16
1407	and             %r9,%r16,%r17
1408	cmpb,<>,n       %r16,%r17,nadtlb_fault /* Must be probe,[rw]*/
1409	BL              get_register,%r25      /* Find the target register */
1410	extrw,u         %r9,31,5,%r8           /* Get target register */
1411	cmpib,COND(=),n        -1,%r1,nadtlb_fault    /* have to use slow path */
1412	BL		set_register,%r25
1413	copy            %r0,%r1                /* Write zero to target register */
1414	b nadtlb_nullify                       /* Nullify return insn */
1415	nop
1416
1417
1418#ifdef CONFIG_64BIT
1419itlb_miss_20w:
1420
1421	/*
1422	 * I miss is a little different, since we allow users to fault
1423	 * on the gateway page which is in the kernel address space.
1424	 */
1425
1426	space_adjust	spc,va,t0
1427	get_pgd		spc,ptp
1428	space_check	spc,t0,itlb_fault
1429
1430	L3_ptep		ptp,pte,t0,va,itlb_fault
1431
1432	update_ptep	ptp,pte,t0,t1
 
1433
1434	make_insert_tlb	spc,pte,prot
1435	
1436	iitlbt          pte,prot
1437
 
1438	rfir
1439	nop
1440
1441naitlb_miss_20w:
1442
1443	/*
1444	 * I miss is a little different, since we allow users to fault
1445	 * on the gateway page which is in the kernel address space.
1446	 */
1447
1448	space_adjust	spc,va,t0
1449	get_pgd		spc,ptp
1450	space_check	spc,t0,naitlb_fault
1451
1452	L3_ptep		ptp,pte,t0,va,naitlb_check_alias_20w
1453
1454	update_ptep	ptp,pte,t0,t1
 
1455
1456	make_insert_tlb	spc,pte,prot
1457
1458	iitlbt          pte,prot
1459
 
1460	rfir
1461	nop
1462
1463naitlb_check_alias_20w:
1464	do_alias	spc,t0,t1,va,pte,prot,naitlb_fault,20
1465
1466	iitlbt		pte,prot
1467
 
1468	rfir
1469	nop
1470
1471#else
1472
1473itlb_miss_11:
1474	get_pgd		spc,ptp
1475
1476	space_check	spc,t0,itlb_fault
1477
1478	L2_ptep		ptp,pte,t0,va,itlb_fault
1479
1480	update_ptep	ptp,pte,t0,t1
 
1481
1482	make_insert_tlb_11	spc,pte,prot
1483
1484	mfsp		%sr1,t0  /* Save sr1 so we can use it in tlb inserts */
1485	mtsp		spc,%sr1
1486
1487	iitlba		pte,(%sr1,va)
1488	iitlbp		prot,(%sr1,va)
1489
1490	mtsp		t0, %sr1	/* Restore sr1 */
1491
 
1492	rfir
1493	nop
1494
1495naitlb_miss_11:
1496	get_pgd		spc,ptp
1497
1498	space_check	spc,t0,naitlb_fault
1499
1500	L2_ptep		ptp,pte,t0,va,naitlb_check_alias_11
1501
1502	update_ptep	ptp,pte,t0,t1
 
1503
1504	make_insert_tlb_11	spc,pte,prot
1505
1506	mfsp		%sr1,t0  /* Save sr1 so we can use it in tlb inserts */
1507	mtsp		spc,%sr1
1508
1509	iitlba		pte,(%sr1,va)
1510	iitlbp		prot,(%sr1,va)
1511
1512	mtsp		t0, %sr1	/* Restore sr1 */
1513
 
1514	rfir
1515	nop
1516
1517naitlb_check_alias_11:
1518	do_alias	spc,t0,t1,va,pte,prot,itlb_fault,11
1519
1520	iitlba          pte,(%sr0, va)
1521	iitlbp          prot,(%sr0, va)
1522
 
1523	rfir
1524	nop
1525
1526
1527itlb_miss_20:
1528	get_pgd		spc,ptp
1529
1530	space_check	spc,t0,itlb_fault
1531
1532	L2_ptep		ptp,pte,t0,va,itlb_fault
1533
1534	update_ptep	ptp,pte,t0,t1
 
1535
1536	make_insert_tlb	spc,pte,prot
1537
1538	f_extend	pte,t0	
1539
1540	iitlbt          pte,prot
1541
 
1542	rfir
1543	nop
1544
1545naitlb_miss_20:
1546	get_pgd		spc,ptp
1547
1548	space_check	spc,t0,naitlb_fault
1549
1550	L2_ptep		ptp,pte,t0,va,naitlb_check_alias_20
1551
1552	update_ptep	ptp,pte,t0,t1
 
1553
1554	make_insert_tlb	spc,pte,prot
1555
1556	f_extend	pte,t0
1557
1558	iitlbt          pte,prot
1559
 
1560	rfir
1561	nop
1562
1563naitlb_check_alias_20:
1564	do_alias	spc,t0,t1,va,pte,prot,naitlb_fault,20
1565
1566	iitlbt          pte,prot
1567
 
1568	rfir
1569	nop
1570
1571#endif
1572
1573#ifdef CONFIG_64BIT
1574
1575dbit_trap_20w:
1576	space_adjust	spc,va,t0
1577	get_pgd		spc,ptp
1578	space_check	spc,t0,dbit_fault
1579
1580	L3_ptep		ptp,pte,t0,va,dbit_fault
1581
1582#ifdef CONFIG_SMP
1583	cmpib,COND(=),n        0,spc,dbit_nolock_20w
1584	load32		PA(pa_dbit_lock),t0
1585
1586dbit_spin_20w:
1587	LDCW		0(t0),t1
1588	cmpib,COND(=)         0,t1,dbit_spin_20w
1589	nop
1590
1591dbit_nolock_20w:
1592#endif
1593	update_dirty	ptp,pte,t1
1594
1595	make_insert_tlb	spc,pte,prot
1596		
1597	idtlbt          pte,prot
1598#ifdef CONFIG_SMP
1599	cmpib,COND(=),n        0,spc,dbit_nounlock_20w
1600	ldi             1,t1
1601	stw             t1,0(t0)
1602
1603dbit_nounlock_20w:
1604#endif
1605
 
1606	rfir
1607	nop
1608#else
1609
1610dbit_trap_11:
1611
1612	get_pgd		spc,ptp
1613
1614	space_check	spc,t0,dbit_fault
1615
1616	L2_ptep		ptp,pte,t0,va,dbit_fault
1617
1618#ifdef CONFIG_SMP
1619	cmpib,COND(=),n        0,spc,dbit_nolock_11
1620	load32		PA(pa_dbit_lock),t0
1621
1622dbit_spin_11:
1623	LDCW		0(t0),t1
1624	cmpib,=         0,t1,dbit_spin_11
1625	nop
1626
1627dbit_nolock_11:
1628#endif
1629	update_dirty	ptp,pte,t1
1630
1631	make_insert_tlb_11	spc,pte,prot
1632
1633	mfsp            %sr1,t1  /* Save sr1 so we can use it in tlb inserts */
1634	mtsp		spc,%sr1
1635
1636	idtlba		pte,(%sr1,va)
1637	idtlbp		prot,(%sr1,va)
1638
1639	mtsp            t1, %sr1     /* Restore sr1 */
1640#ifdef CONFIG_SMP
1641	cmpib,COND(=),n        0,spc,dbit_nounlock_11
1642	ldi             1,t1
1643	stw             t1,0(t0)
1644
1645dbit_nounlock_11:
1646#endif
1647
 
1648	rfir
1649	nop
1650
1651dbit_trap_20:
1652	get_pgd		spc,ptp
1653
1654	space_check	spc,t0,dbit_fault
1655
1656	L2_ptep		ptp,pte,t0,va,dbit_fault
1657
1658#ifdef CONFIG_SMP
1659	cmpib,COND(=),n        0,spc,dbit_nolock_20
1660	load32		PA(pa_dbit_lock),t0
1661
1662dbit_spin_20:
1663	LDCW		0(t0),t1
1664	cmpib,=         0,t1,dbit_spin_20
1665	nop
1666
1667dbit_nolock_20:
1668#endif
1669	update_dirty	ptp,pte,t1
1670
1671	make_insert_tlb	spc,pte,prot
1672
1673	f_extend	pte,t1
1674	
1675        idtlbt          pte,prot
1676
1677#ifdef CONFIG_SMP
1678	cmpib,COND(=),n        0,spc,dbit_nounlock_20
1679	ldi             1,t1
1680	stw             t1,0(t0)
1681
1682dbit_nounlock_20:
1683#endif
1684
 
1685	rfir
1686	nop
1687#endif
1688
1689	.import handle_interruption,code
1690
1691kernel_bad_space:
1692	b               intr_save
1693	ldi             31,%r8  /* Use an unused code */
1694
1695dbit_fault:
1696	b               intr_save
1697	ldi             20,%r8
1698
1699itlb_fault:
1700	b               intr_save
1701	ldi             6,%r8
1702
1703nadtlb_fault:
1704	b               intr_save
1705	ldi             17,%r8
1706
1707naitlb_fault:
1708	b               intr_save
1709	ldi             16,%r8
1710
1711dtlb_fault:
1712	b               intr_save
1713	ldi             15,%r8
1714
1715	/* Register saving semantics for system calls:
1716
1717	   %r1		   clobbered by system call macro in userspace
1718	   %r2		   saved in PT_REGS by gateway page
1719	   %r3  - %r18	   preserved by C code (saved by signal code)
1720	   %r19 - %r20	   saved in PT_REGS by gateway page
1721	   %r21 - %r22	   non-standard syscall args
1722			   stored in kernel stack by gateway page
1723	   %r23 - %r26	   arg3-arg0, saved in PT_REGS by gateway page
1724	   %r27 - %r30	   saved in PT_REGS by gateway page
1725	   %r31		   syscall return pointer
1726	 */
1727
1728	/* Floating point registers (FIXME: what do we do with these?)
1729
1730	   %fr0  - %fr3	   status/exception, not preserved
1731	   %fr4  - %fr7	   arguments
1732	   %fr8	 - %fr11   not preserved by C code
1733	   %fr12 - %fr21   preserved by C code
1734	   %fr22 - %fr31   not preserved by C code
1735	 */
1736
1737	.macro	reg_save regs
1738	STREG	%r3, PT_GR3(\regs)
1739	STREG	%r4, PT_GR4(\regs)
1740	STREG	%r5, PT_GR5(\regs)
1741	STREG	%r6, PT_GR6(\regs)
1742	STREG	%r7, PT_GR7(\regs)
1743	STREG	%r8, PT_GR8(\regs)
1744	STREG	%r9, PT_GR9(\regs)
1745	STREG   %r10,PT_GR10(\regs)
1746	STREG   %r11,PT_GR11(\regs)
1747	STREG   %r12,PT_GR12(\regs)
1748	STREG   %r13,PT_GR13(\regs)
1749	STREG   %r14,PT_GR14(\regs)
1750	STREG   %r15,PT_GR15(\regs)
1751	STREG   %r16,PT_GR16(\regs)
1752	STREG   %r17,PT_GR17(\regs)
1753	STREG   %r18,PT_GR18(\regs)
1754	.endm
1755
1756	.macro	reg_restore regs
1757	LDREG	PT_GR3(\regs), %r3
1758	LDREG	PT_GR4(\regs), %r4
1759	LDREG	PT_GR5(\regs), %r5
1760	LDREG	PT_GR6(\regs), %r6
1761	LDREG	PT_GR7(\regs), %r7
1762	LDREG	PT_GR8(\regs), %r8
1763	LDREG	PT_GR9(\regs), %r9
1764	LDREG   PT_GR10(\regs),%r10
1765	LDREG   PT_GR11(\regs),%r11
1766	LDREG   PT_GR12(\regs),%r12
1767	LDREG   PT_GR13(\regs),%r13
1768	LDREG   PT_GR14(\regs),%r14
1769	LDREG   PT_GR15(\regs),%r15
1770	LDREG   PT_GR16(\regs),%r16
1771	LDREG   PT_GR17(\regs),%r17
1772	LDREG   PT_GR18(\regs),%r18
1773	.endm
1774
1775ENTRY(sys_fork_wrapper)
1776	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30), %r1
 
1777	ldo	TASK_REGS(%r1),%r1
1778	reg_save %r1
1779	mfctl	%cr27, %r3
1780	STREG	%r3, PT_CR27(%r1)
 
 
 
 
1781
1782	STREG	%r2,-RP_OFFSET(%r30)
1783	ldo	FRAME_SIZE(%r30),%r30
1784#ifdef CONFIG_64BIT
1785	ldo	-16(%r30),%r29		/* Reference param save area */
1786#endif
1787
1788	/* These are call-clobbered registers and therefore
1789	   also syscall-clobbered (we hope). */
1790	STREG	%r2,PT_GR19(%r1)	/* save for child */
1791	STREG	%r30,PT_GR21(%r1)
1792
1793	LDREG	PT_GR30(%r1),%r25
1794	copy	%r1,%r24
1795	BL	sys_clone,%r2
1796	ldi	SIGCHLD,%r26
1797
1798	LDREG	-RP_OFFSET-FRAME_SIZE(%r30),%r2
1799wrapper_exit:
1800	ldo	-FRAME_SIZE(%r30),%r30		/* get the stackframe */
1801	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
1802	ldo	TASK_REGS(%r1),%r1	 /* get pt regs */
1803
1804	LDREG	PT_CR27(%r1), %r3
1805	mtctl	%r3, %cr27
1806	reg_restore %r1
1807
1808	/* strace expects syscall # to be preserved in r20 */
1809	ldi	__NR_fork,%r20
1810	bv %r0(%r2)
1811	STREG	%r20,PT_GR20(%r1)
1812ENDPROC(sys_fork_wrapper)
1813
1814	/* Set the return value for the child */
1815ENTRY(child_return)
1816	BL	schedule_tail, %r2
1817	nop
1818
1819	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE-FRAME_SIZE(%r30), %r1
1820	LDREG	TASK_PT_GR19(%r1),%r2
1821	b	wrapper_exit
1822	copy	%r0,%r28
1823ENDPROC(child_return)
1824
1825
1826ENTRY(sys_clone_wrapper)
1827	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
1828	ldo	TASK_REGS(%r1),%r1	/* get pt regs */
1829	reg_save %r1
1830	mfctl	%cr27, %r3
1831	STREG	%r3, PT_CR27(%r1)
1832
1833	STREG	%r2,-RP_OFFSET(%r30)
1834	ldo	FRAME_SIZE(%r30),%r30
1835#ifdef CONFIG_64BIT
1836	ldo	-16(%r30),%r29		/* Reference param save area */
1837#endif
1838
1839	/* WARNING - Clobbers r19 and r21, userspace must save these! */
1840	STREG	%r2,PT_GR19(%r1)	/* save for child */
1841	STREG	%r30,PT_GR21(%r1)
1842	BL	sys_clone,%r2
1843	copy	%r1,%r24
1844
1845	b	wrapper_exit
1846	LDREG	-RP_OFFSET-FRAME_SIZE(%r30),%r2
1847ENDPROC(sys_clone_wrapper)
1848
1849
1850ENTRY(sys_vfork_wrapper)
1851	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
1852	ldo	TASK_REGS(%r1),%r1	/* get pt regs */
1853	reg_save %r1
1854	mfctl	%cr27, %r3
1855	STREG	%r3, PT_CR27(%r1)
1856
1857	STREG	%r2,-RP_OFFSET(%r30)
1858	ldo	FRAME_SIZE(%r30),%r30
1859#ifdef CONFIG_64BIT
1860	ldo	-16(%r30),%r29		/* Reference param save area */
1861#endif
1862
1863	STREG	%r2,PT_GR19(%r1)	/* save for child */
1864	STREG	%r30,PT_GR21(%r1)
1865
1866	BL	sys_vfork,%r2
1867	copy	%r1,%r26
1868
1869	b	wrapper_exit
1870	LDREG	-RP_OFFSET-FRAME_SIZE(%r30),%r2
1871ENDPROC(sys_vfork_wrapper)
1872
1873	
1874	.macro  execve_wrapper execve
1875	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
1876	ldo	TASK_REGS(%r1),%r1	/* get pt regs */
1877
1878	/*
1879	 * Do we need to save/restore r3-r18 here?
1880	 * I don't think so. why would new thread need old
1881	 * threads registers?
1882	 */
1883
1884	/* %arg0 - %arg3 are already saved for us. */
1885
1886	STREG %r2,-RP_OFFSET(%r30)
1887	ldo FRAME_SIZE(%r30),%r30
1888#ifdef CONFIG_64BIT
1889	ldo	-16(%r30),%r29		/* Reference param save area */
1890#endif
1891	BL \execve,%r2
1892	copy %r1,%arg0
1893
1894	ldo -FRAME_SIZE(%r30),%r30
1895	LDREG -RP_OFFSET(%r30),%r2
1896
1897	/* If exec succeeded we need to load the args */
1898
1899	ldo -1024(%r0),%r1
1900	cmpb,>>= %r28,%r1,error_\execve
1901	copy %r2,%r19
1902
1903error_\execve:
1904	bv %r0(%r19)
1905	nop
1906	.endm
1907
1908	.import sys_execve
1909ENTRY(sys_execve_wrapper)
1910	execve_wrapper sys_execve
1911ENDPROC(sys_execve_wrapper)
1912
1913#ifdef CONFIG_64BIT
1914	.import sys32_execve
1915ENTRY(sys32_execve_wrapper)
1916	execve_wrapper sys32_execve
1917ENDPROC(sys32_execve_wrapper)
1918#endif
1919
1920ENTRY(sys_rt_sigreturn_wrapper)
1921	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r26
1922	ldo	TASK_REGS(%r26),%r26	/* get pt regs */
1923	/* Don't save regs, we are going to restore them from sigcontext. */
1924	STREG	%r2, -RP_OFFSET(%r30)
1925#ifdef CONFIG_64BIT
1926	ldo	FRAME_SIZE(%r30), %r30
1927	BL	sys_rt_sigreturn,%r2
1928	ldo	-16(%r30),%r29		/* Reference param save area */
1929#else
1930	BL	sys_rt_sigreturn,%r2
1931	ldo	FRAME_SIZE(%r30), %r30
1932#endif
1933
1934	ldo	-FRAME_SIZE(%r30), %r30
1935	LDREG	-RP_OFFSET(%r30), %r2
1936
1937	/* FIXME: I think we need to restore a few more things here. */
1938	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
1939	ldo	TASK_REGS(%r1),%r1	/* get pt regs */
1940	reg_restore %r1
1941
1942	/* If the signal was received while the process was blocked on a
1943	 * syscall, then r2 will take us to syscall_exit; otherwise r2 will
1944	 * take us to syscall_exit_rfi and on to intr_return.
1945	 */
1946	bv	%r0(%r2)
1947	LDREG	PT_GR28(%r1),%r28  /* reload original r28 for syscall_exit */
1948ENDPROC(sys_rt_sigreturn_wrapper)
1949
1950ENTRY(sys_sigaltstack_wrapper)
1951	/* Get the user stack pointer */
1952	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
1953	ldo	TASK_REGS(%r1),%r24	/* get pt regs */
1954	LDREG	TASK_PT_GR30(%r24),%r24
1955	STREG	%r2, -RP_OFFSET(%r30)
1956#ifdef CONFIG_64BIT
1957	ldo	FRAME_SIZE(%r30), %r30
1958	BL	do_sigaltstack,%r2
1959	ldo	-16(%r30),%r29		/* Reference param save area */
1960#else
1961	BL	do_sigaltstack,%r2
1962	ldo	FRAME_SIZE(%r30), %r30
1963#endif
1964
1965	ldo	-FRAME_SIZE(%r30), %r30
1966	LDREG	-RP_OFFSET(%r30), %r2
1967	bv	%r0(%r2)
1968	nop
1969ENDPROC(sys_sigaltstack_wrapper)
1970
1971#ifdef CONFIG_64BIT
1972ENTRY(sys32_sigaltstack_wrapper)
1973	/* Get the user stack pointer */
1974	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r24
1975	LDREG	TASK_PT_GR30(%r24),%r24
1976	STREG	%r2, -RP_OFFSET(%r30)
1977	ldo	FRAME_SIZE(%r30), %r30
1978	BL	do_sigaltstack32,%r2
1979	ldo	-16(%r30),%r29		/* Reference param save area */
1980
1981	ldo	-FRAME_SIZE(%r30), %r30
1982	LDREG	-RP_OFFSET(%r30), %r2
1983	bv	%r0(%r2)
1984	nop
1985ENDPROC(sys32_sigaltstack_wrapper)
1986#endif
1987
1988ENTRY(syscall_exit)
1989	/* NOTE: HP-UX syscalls also come through here
1990	 * after hpux_syscall_exit fixes up return
1991	 * values. */
1992
1993	/* NOTE: Not all syscalls exit this way.  rt_sigreturn will exit
1994	 * via syscall_exit_rfi if the signal was received while the process
1995	 * was running.
1996	 */
1997
1998	/* save return value now */
1999
2000	mfctl     %cr30, %r1
2001	LDREG     TI_TASK(%r1),%r1
2002	STREG     %r28,TASK_PT_GR28(%r1)
2003
2004#ifdef CONFIG_HPUX
2005/* <linux/personality.h> cannot be easily included */
2006#define PER_HPUX 0x10
2007	ldw	TASK_PERSONALITY(%r1),%r19
2008
2009	/* We can't use "CMPIB<> PER_HPUX" since "im5" field is sign extended */
2010	ldo	  -PER_HPUX(%r19), %r19
2011	cmpib,COND(<>),n 0,%r19,1f
2012
2013	/* Save other hpux returns if personality is PER_HPUX */
2014	STREG     %r22,TASK_PT_GR22(%r1)
2015	STREG     %r29,TASK_PT_GR29(%r1)
20161:
2017
2018#endif /* CONFIG_HPUX */
2019
2020	/* Seems to me that dp could be wrong here, if the syscall involved
2021	 * calling a module, and nothing got round to restoring dp on return.
2022	 */
2023	loadgp
2024
2025syscall_check_resched:
2026
2027	/* check for reschedule */
2028
2029	LDREG	TI_FLAGS-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r19	/* long */
2030	bb,<,n	%r19, 31-TIF_NEED_RESCHED, syscall_do_resched /* forward */
2031
2032	.import do_signal,code
2033syscall_check_sig:
2034	LDREG	TI_FLAGS-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r19
2035	ldi	(_TIF_SIGPENDING|_TIF_NOTIFY_RESUME), %r26
 
2036	and,COND(<>)	%r19, %r26, %r0
2037	b,n	syscall_restore	/* skip past if we've nothing to do */
2038
2039syscall_do_signal:
2040	/* Save callee-save registers (for sigcontext).
2041	 * FIXME: After this point the process structure should be
2042	 * consistent with all the relevant state of the process
2043	 * before the syscall.  We need to verify this.
2044	 */
2045	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
2046	ldo	TASK_REGS(%r1), %r26		/* struct pt_regs *regs */
2047	reg_save %r26
2048
2049#ifdef CONFIG_64BIT
2050	ldo	-16(%r30),%r29			/* Reference param save area */
2051#endif
2052
2053	BL	do_notify_resume,%r2
2054	ldi	1, %r25				/* long in_syscall = 1 */
2055
2056	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
2057	ldo	TASK_REGS(%r1), %r20		/* reload pt_regs */
2058	reg_restore %r20
2059
2060	b,n     syscall_check_sig
2061
2062syscall_restore:
2063	LDREG	TI_TASK-THREAD_SZ_ALGN-FRAME_SIZE(%r30),%r1
2064
2065	/* Are we being ptraced? */
2066	ldw	TASK_FLAGS(%r1),%r19
2067	ldi	(_TIF_SINGLESTEP|_TIF_BLOCKSTEP),%r2
2068	and,COND(=)	%r19,%r2,%r0
2069	b,n	syscall_restore_rfi
2070
2071	ldo	TASK_PT_FR31(%r1),%r19		   /* reload fpregs */
2072	rest_fp	%r19
2073
2074	LDREG	TASK_PT_SAR(%r1),%r19		   /* restore SAR */
2075	mtsar	%r19
2076
2077	LDREG	TASK_PT_GR2(%r1),%r2		   /* restore user rp */
2078	LDREG	TASK_PT_GR19(%r1),%r19
2079	LDREG   TASK_PT_GR20(%r1),%r20
2080	LDREG	TASK_PT_GR21(%r1),%r21
2081	LDREG	TASK_PT_GR22(%r1),%r22
2082	LDREG	TASK_PT_GR23(%r1),%r23
2083	LDREG	TASK_PT_GR24(%r1),%r24
2084	LDREG	TASK_PT_GR25(%r1),%r25
2085	LDREG	TASK_PT_GR26(%r1),%r26
2086	LDREG	TASK_PT_GR27(%r1),%r27	   /* restore user dp */
2087	LDREG	TASK_PT_GR28(%r1),%r28	   /* syscall return value */
2088	LDREG	TASK_PT_GR29(%r1),%r29
2089	LDREG	TASK_PT_GR31(%r1),%r31	   /* restore syscall rp */
2090
2091	/* NOTE: We use rsm/ssm pair to make this operation atomic */
2092	LDREG   TASK_PT_GR30(%r1),%r1              /* Get user sp */
2093	rsm     PSW_SM_I, %r0
2094	copy    %r1,%r30                           /* Restore user sp */
2095	mfsp    %sr3,%r1                           /* Get user space id */
2096	mtsp    %r1,%sr7                           /* Restore sr7 */
2097	ssm     PSW_SM_I, %r0
2098
2099	/* Set sr2 to zero for userspace syscalls to work. */
2100	mtsp	%r0,%sr2 
2101	mtsp	%r1,%sr4			   /* Restore sr4 */
2102	mtsp	%r1,%sr5			   /* Restore sr5 */
2103	mtsp	%r1,%sr6			   /* Restore sr6 */
2104
2105	depi	3,31,2,%r31			   /* ensure return to user mode. */
2106
2107#ifdef CONFIG_64BIT
2108	/* decide whether to reset the wide mode bit
2109	 *
2110	 * For a syscall, the W bit is stored in the lowest bit
2111	 * of sp.  Extract it and reset W if it is zero */
2112	extrd,u,*<>	%r30,63,1,%r1
2113	rsm	PSW_SM_W, %r0
2114	/* now reset the lowest bit of sp if it was set */
2115	xor	%r30,%r1,%r30
2116#endif
2117	be,n    0(%sr3,%r31)                       /* return to user space */
2118
2119	/* We have to return via an RFI, so that PSW T and R bits can be set
2120	 * appropriately.
2121	 * This sets up pt_regs so we can return via intr_restore, which is not
2122	 * the most efficient way of doing things, but it works.
2123	 */
2124syscall_restore_rfi:
2125	ldo	-1(%r0),%r2			   /* Set recovery cntr to -1 */
2126	mtctl	%r2,%cr0			   /*   for immediate trap */
2127	LDREG	TASK_PT_PSW(%r1),%r2		   /* Get old PSW */
2128	ldi	0x0b,%r20			   /* Create new PSW */
2129	depi	-1,13,1,%r20			   /* C, Q, D, and I bits */
2130
2131	/* The values of SINGLESTEP_BIT and BLOCKSTEP_BIT are
2132	 * set in thread_info.h and converted to PA bitmap
2133	 * numbers in asm-offsets.c */
2134
2135	/* if ((%r19.SINGLESTEP_BIT)) { %r20.27=1} */
2136	extru,=	%r19,TIF_SINGLESTEP_PA_BIT,1,%r0
2137	depi	-1,27,1,%r20			   /* R bit */
2138
2139	/* if ((%r19.BLOCKSTEP_BIT)) { %r20.7=1} */
2140	extru,= %r19,TIF_BLOCKSTEP_PA_BIT,1,%r0
2141	depi	-1,7,1,%r20			   /* T bit */
2142
2143	STREG	%r20,TASK_PT_PSW(%r1)
2144
2145	/* Always store space registers, since sr3 can be changed (e.g. fork) */
2146
2147	mfsp    %sr3,%r25
2148	STREG   %r25,TASK_PT_SR3(%r1)
2149	STREG   %r25,TASK_PT_SR4(%r1)
2150	STREG   %r25,TASK_PT_SR5(%r1)
2151	STREG   %r25,TASK_PT_SR6(%r1)
2152	STREG   %r25,TASK_PT_SR7(%r1)
2153	STREG   %r25,TASK_PT_IASQ0(%r1)
2154	STREG   %r25,TASK_PT_IASQ1(%r1)
2155
2156	/* XXX W bit??? */
2157	/* Now if old D bit is clear, it means we didn't save all registers
2158	 * on syscall entry, so do that now.  This only happens on TRACEME
2159	 * calls, or if someone attached to us while we were on a syscall.
2160	 * We could make this more efficient by not saving r3-r18, but
2161	 * then we wouldn't be able to use the common intr_restore path.
2162	 * It is only for traced processes anyway, so performance is not
2163	 * an issue.
2164	 */
2165	bb,<	%r2,30,pt_regs_ok		   /* Branch if D set */
2166	ldo	TASK_REGS(%r1),%r25
2167	reg_save %r25				   /* Save r3 to r18 */
2168
2169	/* Save the current sr */
2170	mfsp	%sr0,%r2
2171	STREG	%r2,TASK_PT_SR0(%r1)
2172
2173	/* Save the scratch sr */
2174	mfsp	%sr1,%r2
2175	STREG	%r2,TASK_PT_SR1(%r1)
2176
2177	/* sr2 should be set to zero for userspace syscalls */
2178	STREG	%r0,TASK_PT_SR2(%r1)
2179
2180pt_regs_ok:
2181	LDREG	TASK_PT_GR31(%r1),%r2
2182	depi	3,31,2,%r2			   /* ensure return to user mode. */
2183	STREG	%r2,TASK_PT_IAOQ0(%r1)
2184	ldo	4(%r2),%r2
2185	STREG	%r2,TASK_PT_IAOQ1(%r1)
 
2186	copy	%r25,%r16
 
 
 
 
 
 
 
 
2187	b	intr_restore
2188	nop
2189
2190	.import schedule,code
2191syscall_do_resched:
2192	BL	schedule,%r2
 
 
2193#ifdef CONFIG_64BIT
2194	ldo	-16(%r30),%r29		/* Reference param save area */
2195#else
2196	nop
2197#endif
2198	b	syscall_check_resched	/* if resched, we start over again */
2199	nop
2200ENDPROC(syscall_exit)
2201
2202
2203#ifdef CONFIG_FUNCTION_TRACER
 
2204	.import ftrace_function_trampoline,code
2205ENTRY(_mcount)
2206	copy	%r3, %arg2
 
 
 
 
 
 
 
 
 
2207	b	ftrace_function_trampoline
 
 
 
 
 
 
 
 
 
2208	nop
2209ENDPROC(_mcount)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2210
2211ENTRY(return_to_handler)
2212	load32	return_trampoline, %rp
2213	copy	%ret0, %arg0
2214	copy	%ret1, %arg1
2215	b	ftrace_return_to_handler
2216	nop
2217return_trampoline:
2218	copy	%ret0, %rp
2219	copy	%r23, %ret0
2220	copy	%r24, %ret1
2221
2222.globl ftrace_stub
2223ftrace_stub:
 
 
2224	bv	%r0(%rp)
2225	nop
2226ENDPROC(return_to_handler)
 
 
 
 
2227#endif	/* CONFIG_FUNCTION_TRACER */
2228
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2229
2230get_register:
2231	/*
2232	 * get_register is used by the non access tlb miss handlers to
2233	 * copy the value of the general register specified in r8 into
2234	 * r1. This routine can't be used for shadowed registers, since
2235	 * the rfir will restore the original value. So, for the shadowed
2236	 * registers we put a -1 into r1 to indicate that the register
2237	 * should not be used (the register being copied could also have
2238	 * a -1 in it, but that is OK, it just means that we will have
2239	 * to use the slow path instead).
2240	 */
2241	blr     %r8,%r0
2242	nop
2243	bv      %r0(%r25)    /* r0 */
2244	copy    %r0,%r1
2245	bv      %r0(%r25)    /* r1 - shadowed */
2246	ldi     -1,%r1
2247	bv      %r0(%r25)    /* r2 */
2248	copy    %r2,%r1
2249	bv      %r0(%r25)    /* r3 */
2250	copy    %r3,%r1
2251	bv      %r0(%r25)    /* r4 */
2252	copy    %r4,%r1
2253	bv      %r0(%r25)    /* r5 */
2254	copy    %r5,%r1
2255	bv      %r0(%r25)    /* r6 */
2256	copy    %r6,%r1
2257	bv      %r0(%r25)    /* r7 */
2258	copy    %r7,%r1
2259	bv      %r0(%r25)    /* r8 - shadowed */
2260	ldi     -1,%r1
2261	bv      %r0(%r25)    /* r9 - shadowed */
2262	ldi     -1,%r1
2263	bv      %r0(%r25)    /* r10 */
2264	copy    %r10,%r1
2265	bv      %r0(%r25)    /* r11 */
2266	copy    %r11,%r1
2267	bv      %r0(%r25)    /* r12 */
2268	copy    %r12,%r1
2269	bv      %r0(%r25)    /* r13 */
2270	copy    %r13,%r1
2271	bv      %r0(%r25)    /* r14 */
2272	copy    %r14,%r1
2273	bv      %r0(%r25)    /* r15 */
2274	copy    %r15,%r1
2275	bv      %r0(%r25)    /* r16 - shadowed */
2276	ldi     -1,%r1
2277	bv      %r0(%r25)    /* r17 - shadowed */
2278	ldi     -1,%r1
2279	bv      %r0(%r25)    /* r18 */
2280	copy    %r18,%r1
2281	bv      %r0(%r25)    /* r19 */
2282	copy    %r19,%r1
2283	bv      %r0(%r25)    /* r20 */
2284	copy    %r20,%r1
2285	bv      %r0(%r25)    /* r21 */
2286	copy    %r21,%r1
2287	bv      %r0(%r25)    /* r22 */
2288	copy    %r22,%r1
2289	bv      %r0(%r25)    /* r23 */
2290	copy    %r23,%r1
2291	bv      %r0(%r25)    /* r24 - shadowed */
2292	ldi     -1,%r1
2293	bv      %r0(%r25)    /* r25 - shadowed */
2294	ldi     -1,%r1
2295	bv      %r0(%r25)    /* r26 */
2296	copy    %r26,%r1
2297	bv      %r0(%r25)    /* r27 */
2298	copy    %r27,%r1
2299	bv      %r0(%r25)    /* r28 */
2300	copy    %r28,%r1
2301	bv      %r0(%r25)    /* r29 */
2302	copy    %r29,%r1
2303	bv      %r0(%r25)    /* r30 */
2304	copy    %r30,%r1
2305	bv      %r0(%r25)    /* r31 */
2306	copy    %r31,%r1
 
2307
2308
2309set_register:
2310	/*
2311	 * set_register is used by the non access tlb miss handlers to
2312	 * copy the value of r1 into the general register specified in
2313	 * r8.
2314	 */
2315	blr     %r8,%r0
2316	nop
2317	bv      %r0(%r25)    /* r0 (silly, but it is a place holder) */
2318	copy    %r1,%r0
2319	bv      %r0(%r25)    /* r1 */
2320	copy    %r1,%r1
2321	bv      %r0(%r25)    /* r2 */
2322	copy    %r1,%r2
2323	bv      %r0(%r25)    /* r3 */
2324	copy    %r1,%r3
2325	bv      %r0(%r25)    /* r4 */
2326	copy    %r1,%r4
2327	bv      %r0(%r25)    /* r5 */
2328	copy    %r1,%r5
2329	bv      %r0(%r25)    /* r6 */
2330	copy    %r1,%r6
2331	bv      %r0(%r25)    /* r7 */
2332	copy    %r1,%r7
2333	bv      %r0(%r25)    /* r8 */
2334	copy    %r1,%r8
2335	bv      %r0(%r25)    /* r9 */
2336	copy    %r1,%r9
2337	bv      %r0(%r25)    /* r10 */
2338	copy    %r1,%r10
2339	bv      %r0(%r25)    /* r11 */
2340	copy    %r1,%r11
2341	bv      %r0(%r25)    /* r12 */
2342	copy    %r1,%r12
2343	bv      %r0(%r25)    /* r13 */
2344	copy    %r1,%r13
2345	bv      %r0(%r25)    /* r14 */
2346	copy    %r1,%r14
2347	bv      %r0(%r25)    /* r15 */
2348	copy    %r1,%r15
2349	bv      %r0(%r25)    /* r16 */
2350	copy    %r1,%r16
2351	bv      %r0(%r25)    /* r17 */
2352	copy    %r1,%r17
2353	bv      %r0(%r25)    /* r18 */
2354	copy    %r1,%r18
2355	bv      %r0(%r25)    /* r19 */
2356	copy    %r1,%r19
2357	bv      %r0(%r25)    /* r20 */
2358	copy    %r1,%r20
2359	bv      %r0(%r25)    /* r21 */
2360	copy    %r1,%r21
2361	bv      %r0(%r25)    /* r22 */
2362	copy    %r1,%r22
2363	bv      %r0(%r25)    /* r23 */
2364	copy    %r1,%r23
2365	bv      %r0(%r25)    /* r24 */
2366	copy    %r1,%r24
2367	bv      %r0(%r25)    /* r25 */
2368	copy    %r1,%r25
2369	bv      %r0(%r25)    /* r26 */
2370	copy    %r1,%r26
2371	bv      %r0(%r25)    /* r27 */
2372	copy    %r1,%r27
2373	bv      %r0(%r25)    /* r28 */
2374	copy    %r1,%r28
2375	bv      %r0(%r25)    /* r29 */
2376	copy    %r1,%r29
2377	bv      %r0(%r25)    /* r30 */
2378	copy    %r1,%r30
2379	bv      %r0(%r25)    /* r31 */
2380	copy    %r1,%r31
 
2381