1
   2/*    low-level asm for "intrigue" (PA8500-8700 CPU perf counters)
   3 * 
   4 *    Copyright (C) 2001 Randolph Chung <tausq at parisc-linux.org>
   5 *    Copyright (C) 2001 Hewlett-Packard (Grant Grundler)
   6 * 
   7 *    This program is free software; you can redistribute it and/or modify
   8 *    it under the terms of the GNU General Public License as published by
   9 *    the Free Software Foundation; either version 2 of the License, or
  10 *    (at your option) any later version.
  11 * 
  12 *    This program is distributed in the hope that it will be useful,
  13 *    but WITHOUT ANY WARRANTY; without even the implied warranty of
  14 *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15 *    GNU General Public License for more details.
  16 * 
  17 *    You should have received a copy of the GNU General Public License
  18 *    along with this program; if not, write to the Free Software
  19 *    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  20 */
  21
  22#include <asm/assembly.h>
  23
  24#include <linux/init.h>
  25#include <linux/linkage.h>
  26
  27#ifdef CONFIG_64BIT
  28	.level		2.0w
  29#endif /* CONFIG_64BIT */
  30
  31#define MTDIAG_1(gr)    .word 0x14201840 + gr*0x10000
  32#define MTDIAG_2(gr)    .word 0x14401840 + gr*0x10000
  33#define MFDIAG_1(gr)    .word 0x142008A0 + gr
  34#define MFDIAG_2(gr)    .word 0x144008A0 + gr
  35#define STDIAG(dr)      .word 0x14000AA0 + dr*0x200000
  36#define SFDIAG(dr)      .word 0x14000BA0 + dr*0x200000
  37#define DR2_SLOW_RET    53
  38
  39
  40;
  41; Enable the performance counters
  42;
  43; The coprocessor only needs to be enabled when
  44; starting/stopping the coprocessor with the pmenb/pmdis.
  45;
  46	.text
  47
  48ENTRY(perf_intrigue_enable_perf_counters)
  49	.proc
  50	.callinfo  frame=0,NO_CALLS
  51	.entry
  52
  53	ldi     0x20,%r25                ; load up perfmon bit
  54	mfctl   ccr,%r26                 ; get coprocessor register
  55	or      %r25,%r26,%r26             ; set bit
  56	mtctl   %r26,ccr                 ; turn on performance coprocessor
  57	pmenb                           ; enable performance monitor
  58	ssm     0,0                     ; dummy op to ensure completion
  59	sync                            ; follow ERS
  60	andcm   %r26,%r25,%r26             ; clear bit now 
  61	mtctl   %r26,ccr                 ; turn off performance coprocessor
  62	nop                             ; NOPs as specified in ERS
  63	nop
  64	nop
  65	nop
  66	nop
  67	nop
  68	nop
  69	bve    (%r2)
  70	nop
  71	.exit
  72	.procend
  73ENDPROC(perf_intrigue_enable_perf_counters)
  74
  75ENTRY(perf_intrigue_disable_perf_counters)
  76	.proc
  77	.callinfo  frame=0,NO_CALLS
  78	.entry
  79	ldi     0x20,%r25                ; load up perfmon bit
  80	mfctl   ccr,%r26                 ; get coprocessor register
  81	or      %r25,%r26,%r26             ; set bit
  82	mtctl   %r26,ccr                 ; turn on performance coprocessor
  83	pmdis                           ; disable performance monitor
  84	ssm     0,0                     ; dummy op to ensure completion
  85	andcm   %r26,%r25,%r26             ; clear bit now 
  86	bve    (%r2)
  87	mtctl   %r26,ccr                 ; turn off performance coprocessor
  88	.exit
  89	.procend
  90ENDPROC(perf_intrigue_disable_perf_counters)
  91
  92;***********************************************************************
  93;*
  94;* Name: perf_rdr_shift_in_W
  95;*
  96;* Description:
  97;*	This routine shifts data in from the RDR in arg0 and returns
  98;*	the result in ret0.  If the RDR is <= 64 bits in length, it
  99;*	is shifted shifted backup immediately.  This is to compensate
 100;*	for RDR10 which has bits that preclude PDC stack operations
 101;*	when they are in the wrong state.
 102;*
 103;* Arguments:
 104;*	arg0 : rdr to be read
 105;*	arg1 : bit length of rdr
 106;*
 107;* Returns:
 108;*	ret0 = next 64 bits of rdr data from staging register
 109;*
 110;* Register usage:
 111;*	arg0 : rdr to be read
 112;*	arg1 : bit length of rdr
 113;*	%r24  - original DR2 value
 114;*	%r1   - scratch
 115;*  %r29  - scratch
 116;*
 117;* Returns:
 118;*	ret0 = RDR data (right justified)
 119;*
 120;***********************************************************************
 121
 122ENTRY(perf_rdr_shift_in_W)
 123	.proc
 124	.callinfo frame=0,NO_CALLS
 125	.entry
 126;
 127; read(shift in) the RDR.
 128;
 129
 130; NOTE: The PCX-W ERS states that DR2_SLOW_RET must be set before any
 131; shifting is done, from or to, remote diagnose registers.
 132;
 133
 134	depdi,z		1,DR2_SLOW_RET,1,%r29
 135	MFDIAG_2	(24)
 136	or		    %r24,%r29,%r29
 137	MTDIAG_2	(29)			; set DR2_SLOW_RET
 138
 139	nop
 140	nop
 141	nop
 142	nop
 143
 144;
 145; Cacheline start (32-byte cacheline)
 146;
 147	nop
 148	nop
 149	nop
 150	extrd,u		arg1,63,6,%r1	; setup shift amount by bits to move 
 151
 152	mtsar		%r1
 153	shladd		arg0,2,%r0,%r1	; %r1 = 4 * RDR number
 154	blr  		%r1,%r0		; branch to 8-instruction sequence
 155	nop
 156
 157;
 158; Cacheline start (32-byte cacheline)
 159;
 160
 161	;
 162	; RDR 0 sequence
 163	;
 164	SFDIAG		(0)
 165	ssm		    0,0
 166	MFDIAG_1	(28)
 167	shrpd		ret0,%r0,%sar,%r1
 168	MTDIAG_1	(1)			; mtdiag %dr1, %r1 
 169	STDIAG		(0)
 170	ssm		    0,0
 171	b,n         perf_rdr_shift_in_W_leave
 172
 173	;
 174	; RDR 1 sequence
 175	;
 176	sync
 177	ssm		    0,0
 178	SFDIAG		(1)
 179	ssm		    0,0
 180	MFDIAG_1	(28)
 181	ssm		    0,0
 182	b,n         perf_rdr_shift_in_W_leave
 183	nop
 184
 185	;
 186	; RDR 2 read sequence
 187	;
 188	SFDIAG		(2)
 189	ssm		    0,0
 190	MFDIAG_1	(28)
 191	shrpd		ret0,%r0,%sar,%r1
 192	MTDIAG_1	(1)
 193	STDIAG		(2)
 194	ssm		    0,0
 195	b,n         perf_rdr_shift_in_W_leave
 196
 197	;
 198	; RDR 3 read sequence
 199	;
 200	b,n         perf_rdr_shift_in_W_leave
 201	nop
 202	nop
 203	nop
 204	nop
 205	nop
 206	nop
 207	nop
 208
 209	;
 210	; RDR 4 read sequence
 211	;
 212	sync
 213	ssm		0,0
 214	SFDIAG		(4)
 215	ssm		0,0
 216	MFDIAG_1	(28)
 217	b,n         perf_rdr_shift_in_W_leave
 218	ssm		0,0
 219	nop
 220
 221	; 
 222	; RDR 5 read sequence
 223	;
 224	sync
 225	ssm		0,0
 226	SFDIAG		(5)
 227	ssm		0,0
 228	MFDIAG_1	(28)
 229	b,n         perf_rdr_shift_in_W_leave
 230	ssm		0,0
 231	nop
 232
 233	;
 234	; RDR 6 read sequence
 235	;
 236	sync
 237	ssm		0,0
 238	SFDIAG		(6)
 239	ssm		0,0
 240	MFDIAG_1	(28)
 241	b,n         perf_rdr_shift_in_W_leave
 242	ssm		0,0
 243	nop
 244
 245	;
 246	; RDR 7 read sequence
 247	;
 248	b,n         perf_rdr_shift_in_W_leave
 249	nop
 250	nop
 251	nop
 252	nop
 253	nop
 254	nop
 255	nop
 256
 257	;
 258	; RDR 8 read sequence
 259	;
 260	b,n         perf_rdr_shift_in_W_leave
 261	nop
 262	nop
 263	nop
 264	nop
 265	nop
 266	nop
 267	nop
 268
 269	;
 270	; RDR 9 read sequence
 271	;
 272	b,n         perf_rdr_shift_in_W_leave
 273	nop
 274	nop
 275	nop
 276	nop
 277	nop
 278	nop
 279	nop
 280
 281	;
 282	; RDR 10 read sequence
 283	;
 284	SFDIAG		(10)
 285	ssm		0,0
 286	MFDIAG_1	(28)
 287	shrpd		ret0,%r0,%sar,%r1
 288	MTDIAG_1	(1)
 289	STDIAG		(10)
 290	ssm		0,0
 291	b,n         perf_rdr_shift_in_W_leave
 292
 293	;
 294	; RDR 11 read sequence
 295	;
 296	SFDIAG		(11)
 297	ssm		0,0
 298	MFDIAG_1	(28)
 299	shrpd		ret0,%r0,%sar,%r1
 300	MTDIAG_1	(1)
 301	STDIAG		(11)
 302	ssm		0,0
 303	b,n         perf_rdr_shift_in_W_leave
 304
 305	;
 306	; RDR 12 read sequence
 307	;
 308	b,n         perf_rdr_shift_in_W_leave
 309	nop
 310	nop
 311	nop
 312	nop
 313	nop
 314	nop
 315	nop
 316
 317	;
 318	; RDR 13 read sequence
 319	;
 320	sync
 321	ssm		0,0
 322	SFDIAG		(13)
 323	ssm		0,0
 324	MFDIAG_1	(28)
 325	b,n         perf_rdr_shift_in_W_leave
 326	ssm		0,0
 327	nop
 328
 329	;
 330	; RDR 14 read sequence
 331	;
 332	SFDIAG		(14)
 333	ssm		0,0
 334	MFDIAG_1	(28)
 335	shrpd		ret0,%r0,%sar,%r1
 336	MTDIAG_1	(1)
 337	STDIAG		(14)
 338	ssm		0,0
 339	b,n         perf_rdr_shift_in_W_leave
 340
 341	;
 342	; RDR 15 read sequence
 343	;
 344	sync
 345	ssm		0,0
 346	SFDIAG		(15)
 347	ssm		0,0
 348	MFDIAG_1	(28)
 349	ssm		0,0
 350	b,n         perf_rdr_shift_in_W_leave
 351	nop
 352
 353	;
 354	; RDR 16 read sequence
 355	;
 356	sync
 357	ssm		0,0
 358	SFDIAG		(16)
 359	ssm		0,0
 360	MFDIAG_1	(28)
 361	b,n         perf_rdr_shift_in_W_leave
 362	ssm		0,0
 363	nop
 364
 365	;
 366	; RDR 17 read sequence
 367	;
 368	SFDIAG		(17)
 369	ssm		0,0
 370	MFDIAG_1	(28)
 371	shrpd		ret0,%r0,%sar,%r1
 372	MTDIAG_1	(1)
 373	STDIAG		(17)
 374	ssm		0,0
 375	b,n         perf_rdr_shift_in_W_leave
 376
 377	;
 378	; RDR 18 read sequence
 379	;
 380	SFDIAG		(18)
 381	ssm		0,0
 382	MFDIAG_1	(28)
 383	shrpd		ret0,%r0,%sar,%r1
 384	MTDIAG_1	(1)
 385	STDIAG		(18)
 386	ssm		0,0
 387	b,n         perf_rdr_shift_in_W_leave
 388
 389	;
 390	; RDR 19 read sequence
 391	;
 392	b,n         perf_rdr_shift_in_W_leave
 393	nop
 394	nop
 395	nop
 396	nop
 397	nop
 398	nop
 399	nop
 400
 401	;
 402	; RDR 20 read sequence
 403	;
 404	sync
 405	ssm		0,0
 406	SFDIAG		(20)
 407	ssm		0,0
 408	MFDIAG_1	(28)
 409	b,n         perf_rdr_shift_in_W_leave
 410	ssm		0,0
 411	nop
 412
 413	;
 414	; RDR 21 read sequence
 415	;
 416	sync
 417	ssm		0,0
 418	SFDIAG		(21)
 419	ssm		0,0
 420	MFDIAG_1	(28)
 421	b,n         perf_rdr_shift_in_W_leave
 422	ssm		0,0
 423	nop
 424
 425	;
 426	; RDR 22 read sequence
 427	;
 428	sync
 429	ssm		0,0
 430	SFDIAG		(22)
 431	ssm		0,0
 432	MFDIAG_1	(28)
 433	b,n         perf_rdr_shift_in_W_leave
 434	ssm		0,0
 435	nop
 436
 437	;
 438	; RDR 23 read sequence
 439	;
 440	sync
 441	ssm		0,0
 442	SFDIAG		(23)
 443	ssm		0,0
 444	MFDIAG_1	(28)
 445	b,n         perf_rdr_shift_in_W_leave
 446	ssm		0,0
 447	nop
 448
 449	;
 450	; RDR 24 read sequence
 451	;
 452	sync
 453	ssm		0,0
 454	SFDIAG		(24)
 455	ssm		0,0
 456	MFDIAG_1	(28)
 457	b,n         perf_rdr_shift_in_W_leave
 458	ssm		0,0
 459	nop
 460
 461	;
 462	; RDR 25 read sequence
 463	;
 464	sync
 465	ssm		0,0
 466	SFDIAG		(25)
 467	ssm		0,0
 468	MFDIAG_1	(28)
 469	b,n         perf_rdr_shift_in_W_leave
 470	ssm		0,0
 471	nop
 472
 473	;
 474	; RDR 26 read sequence
 475	;
 476	SFDIAG		(26)
 477	ssm		0,0
 478	MFDIAG_1	(28)
 479	shrpd		ret0,%r0,%sar,%r1
 480	MTDIAG_1	(1)
 481	STDIAG		(26)
 482	ssm		0,0
 483	b,n         perf_rdr_shift_in_W_leave
 484
 485	;
 486	; RDR 27 read sequence
 487	;
 488	SFDIAG		(27)
 489	ssm		0,0
 490	MFDIAG_1	(28)
 491	shrpd		ret0,%r0,%sar,%r1
 492	MTDIAG_1	(1)
 493	STDIAG		(27)
 494	ssm		0,0
 495	b,n         perf_rdr_shift_in_W_leave
 496
 497	;
 498	; RDR 28 read sequence
 499	;
 500	sync
 501	ssm		0,0
 502	SFDIAG		(28)
 503	ssm		0,0
 504	MFDIAG_1	(28)
 505	b,n         perf_rdr_shift_in_W_leave
 506	ssm		0,0
 507	nop
 508
 509	;
 510	; RDR 29 read sequence
 511	;
 512	sync
 513	ssm		0,0
 514	SFDIAG		(29)
 515	ssm		0,0
 516	MFDIAG_1	(28)
 517	b,n         perf_rdr_shift_in_W_leave
 518	ssm		0,0
 519	nop
 520
 521	;
 522	; RDR 30 read sequence
 523	;
 524	SFDIAG		(30)
 525	ssm		0,0
 526	MFDIAG_1	(28)
 527	shrpd		ret0,%r0,%sar,%r1
 528	MTDIAG_1	(1)
 529	STDIAG		(30)
 530	ssm		0,0
 531	b,n         perf_rdr_shift_in_W_leave
 532
 533	;
 534	; RDR 31 read sequence
 535	;
 536	sync
 537	ssm		0,0
 538	SFDIAG		(31)
 539	ssm		0,0
 540	MFDIAG_1	(28)
 541	nop
 542	ssm		0,0
 543	nop
 544
 545	;
 546	; Fallthrough
 547	;
 548
 549perf_rdr_shift_in_W_leave:
 550	bve		    (%r2)
 551	.exit
 552	MTDIAG_2	(24)			; restore DR2
 553	.procend
 554ENDPROC(perf_rdr_shift_in_W)
 555
 556
 557;***********************************************************************
 558;*
 559;* Name: perf_rdr_shift_out_W
 560;*
 561;* Description:
 562;*	This routine moves data to the RDR's.  The double-word that
 563;*	arg1 points to is loaded and moved into the staging register.
 564;*	Then the STDIAG instruction for the RDR # in arg0 is called
 565;*	to move the data to the RDR.
 566;*
 567;* Arguments:
 568;*	arg0 = rdr number
 569;*	arg1 = 64-bit value to write
 570;*	%r24 - DR2 | DR2_SLOW_RET
 571;*	%r23 - original DR2 value
 572;*
 573;* Returns:
 574;*	None
 575;*
 576;* Register usage:
 577;*
 578;***********************************************************************
 579
 580ENTRY(perf_rdr_shift_out_W)
 581	.proc
 582	.callinfo frame=0,NO_CALLS
 583	.entry
 584;
 585; NOTE: The PCX-W ERS states that DR2_SLOW_RET must be set before any
 586; shifting is done, from or to, the remote diagnose registers.
 587;
 588
 589	depdi,z		1,DR2_SLOW_RET,1,%r24
 590	MFDIAG_2	(23)
 591	or		%r24,%r23,%r24
 592	MTDIAG_2	(24)		; set DR2_SLOW_RET
 593	MTDIAG_1	(25)		; data to the staging register
 594	shladd		arg0,2,%r0,%r1	; %r1 = 4 * RDR number
 595	blr		    %r1,%r0	; branch to 8-instruction sequence
 596	nop
 597
 598	;
 599	; RDR 0 write sequence
 600	;
 601	sync				; RDR 0 write sequence
 602	ssm		0,0
 603	STDIAG		(0)
 604	ssm		0,0
 605	b,n         perf_rdr_shift_out_W_leave
 606	nop
 607	ssm		0,0
 608	nop
 609
 610	;
 611	; RDR 1 write sequence
 612	;
 613	sync
 614	ssm		0,0
 615	STDIAG		(1)
 616	ssm		0,0
 617	b,n         perf_rdr_shift_out_W_leave
 618	nop
 619	ssm		0,0
 620	nop
 621
 622	;
 623	; RDR 2 write sequence
 624	;
 625	sync
 626	ssm		0,0
 627	STDIAG		(2)
 628	ssm		0,0
 629	b,n         perf_rdr_shift_out_W_leave
 630	nop
 631	ssm		0,0
 632	nop
 633
 634	;
 635	; RDR 3 write sequence
 636	;
 637	sync
 638	ssm		0,0
 639	STDIAG		(3)
 640	ssm		0,0
 641	b,n         perf_rdr_shift_out_W_leave
 642	nop
 643	ssm		0,0
 644	nop
 645
 646	;
 647	; RDR 4 write sequence
 648	;
 649	sync
 650	ssm		0,0
 651	STDIAG		(4)
 652	ssm		0,0
 653	b,n         perf_rdr_shift_out_W_leave
 654	nop
 655	ssm		0,0
 656	nop
 657
 658	;
 659	; RDR 5 write sequence
 660	;
 661	sync
 662	ssm		0,0
 663	STDIAG		(5)
 664	ssm		0,0
 665	b,n         perf_rdr_shift_out_W_leave
 666	nop
 667	ssm		0,0
 668	nop
 669
 670	;
 671	; RDR 6 write sequence
 672	;
 673	sync
 674	ssm		0,0
 675	STDIAG		(6)
 676	ssm		0,0
 677	b,n         perf_rdr_shift_out_W_leave
 678	nop
 679	ssm		0,0
 680	nop
 681
 682	;
 683	; RDR 7 write sequence
 684	;
 685	sync
 686	ssm		0,0
 687	STDIAG		(7)
 688	ssm		0,0
 689	b,n         perf_rdr_shift_out_W_leave
 690	nop
 691	ssm		0,0
 692	nop
 693
 694	;
 695	; RDR 8 write sequence
 696	;
 697	sync
 698	ssm		0,0
 699	STDIAG		(8)
 700	ssm		0,0
 701	b,n         perf_rdr_shift_out_W_leave
 702	nop
 703	ssm		0,0
 704	nop
 705
 706	;
 707	; RDR 9 write sequence
 708	;
 709	sync
 710	ssm		0,0
 711	STDIAG		(9)
 712	ssm		0,0
 713	b,n         perf_rdr_shift_out_W_leave
 714	nop
 715	ssm		0,0
 716	nop
 717
 718	;
 719	; RDR 10 write sequence
 720	;
 721	sync
 722	ssm		0,0
 723	STDIAG		(10)
 724	STDIAG		(26)
 725	ssm		0,0
 726	b,n         perf_rdr_shift_out_W_leave
 727	ssm		0,0
 728	nop
 729
 730	;
 731	; RDR 11 write sequence
 732	;
 733	sync
 734	ssm		0,0
 735	STDIAG		(11)
 736	STDIAG		(27)
 737	ssm		0,0
 738	b,n         perf_rdr_shift_out_W_leave
 739	ssm		0,0
 740	nop
 741
 742	;
 743	; RDR 12 write sequence
 744	;
 745	sync
 746	ssm		0,0
 747	STDIAG		(12)
 748	ssm		0,0
 749	b,n         perf_rdr_shift_out_W_leave
 750	nop
 751	ssm		0,0
 752	nop
 753
 754	;
 755	; RDR 13 write sequence
 756	;
 757	sync
 758	ssm		0,0
 759	STDIAG		(13)
 760	ssm		0,0
 761	b,n         perf_rdr_shift_out_W_leave
 762	nop
 763	ssm		0,0
 764	nop
 765
 766	;
 767	; RDR 14 write sequence
 768	;
 769	sync
 770	ssm		0,0
 771	STDIAG		(14)
 772	ssm		0,0
 773	b,n         perf_rdr_shift_out_W_leave
 774	nop
 775	ssm		0,0
 776	nop
 777
 778	;
 779	; RDR 15 write sequence
 780	;
 781	sync
 782	ssm		0,0
 783	STDIAG		(15)
 784	ssm		0,0
 785	b,n         perf_rdr_shift_out_W_leave
 786	nop
 787	ssm		0,0
 788	nop
 789
 790	;
 791	; RDR 16 write sequence
 792	;
 793	sync
 794	ssm		0,0
 795	STDIAG		(16)
 796	ssm		0,0
 797	b,n         perf_rdr_shift_out_W_leave
 798	nop
 799	ssm		0,0
 800	nop
 801
 802	;
 803	; RDR 17 write sequence
 804	;
 805	sync
 806	ssm		0,0
 807	STDIAG		(17)
 808	ssm		0,0
 809	b,n         perf_rdr_shift_out_W_leave
 810	nop
 811	ssm		0,0
 812	nop
 813
 814	;
 815	; RDR 18 write sequence
 816	;
 817	sync
 818	ssm		0,0
 819	STDIAG		(18)
 820	ssm		0,0
 821	b,n         perf_rdr_shift_out_W_leave
 822	nop
 823	ssm		0,0
 824	nop
 825
 826	;
 827	; RDR 19 write sequence
 828	;
 829	sync
 830	ssm		0,0
 831	STDIAG		(19)
 832	ssm		0,0
 833	b,n         perf_rdr_shift_out_W_leave
 834	nop
 835	ssm		0,0
 836	nop
 837
 838	;
 839	; RDR 20 write sequence
 840	;
 841	sync
 842	ssm		0,0
 843	STDIAG		(20)
 844	ssm		0,0
 845	b,n         perf_rdr_shift_out_W_leave
 846	nop
 847	ssm		0,0
 848	nop
 849
 850	;
 851	; RDR 21 write sequence
 852	;
 853	sync
 854	ssm		0,0
 855	STDIAG		(21)
 856	ssm		0,0
 857	b,n         perf_rdr_shift_out_W_leave
 858	nop
 859	ssm		0,0
 860	nop
 861
 862	;
 863	; RDR 22 write sequence
 864	;
 865	sync
 866	ssm		0,0
 867	STDIAG		(22)
 868	ssm		0,0
 869	b,n         perf_rdr_shift_out_W_leave
 870	nop
 871	ssm		0,0
 872	nop
 873
 874	;
 875	; RDR 23 write sequence
 876	;
 877	sync
 878	ssm		0,0
 879	STDIAG		(23)
 880	ssm		0,0
 881	b,n         perf_rdr_shift_out_W_leave
 882	nop
 883	ssm		0,0
 884	nop
 885
 886	;
 887	; RDR 24 write sequence
 888	;
 889	sync
 890	ssm		0,0
 891	STDIAG		(24)
 892	ssm		0,0
 893	b,n         perf_rdr_shift_out_W_leave
 894	nop
 895	ssm		0,0
 896	nop
 897
 898	;
 899	; RDR 25 write sequence
 900	;
 901	sync
 902	ssm		0,0
 903	STDIAG		(25)
 904	ssm		0,0
 905	b,n         perf_rdr_shift_out_W_leave
 906	nop
 907	ssm		0,0
 908	nop
 909
 910	;
 911	; RDR 26 write sequence
 912	;
 913	sync
 914	ssm		0,0
 915	STDIAG		(10)
 916	STDIAG		(26)
 917	ssm		0,0
 918	b,n         perf_rdr_shift_out_W_leave
 919	ssm		0,0
 920	nop
 921
 922	;
 923	; RDR 27 write sequence
 924	;
 925	sync
 926	ssm		0,0
 927	STDIAG		(11)
 928	STDIAG		(27)
 929	ssm		0,0
 930	b,n         perf_rdr_shift_out_W_leave
 931	ssm		0,0
 932	nop
 933
 934	;
 935	; RDR 28 write sequence
 936	;
 937	sync
 938	ssm		0,0
 939	STDIAG		(28)
 940	ssm		0,0
 941	b,n         perf_rdr_shift_out_W_leave
 942	nop
 943	ssm		0,0
 944	nop
 945
 946	;
 947	; RDR 29 write sequence
 948	;
 949	sync
 950	ssm		0,0
 951	STDIAG		(29)
 952	ssm		0,0
 953	b,n         perf_rdr_shift_out_W_leave
 954	nop
 955	ssm		0,0
 956	nop
 957
 958	;
 959	; RDR 30 write sequence
 960	;
 961	sync
 962	ssm		0,0
 963	STDIAG		(30)
 964	ssm		0,0
 965	b,n         perf_rdr_shift_out_W_leave
 966	nop
 967	ssm		0,0
 968	nop
 969
 970	;
 971	; RDR 31 write sequence
 972	;
 973	sync
 974	ssm		0,0
 975	STDIAG		(31)
 976	ssm		0,0
 977	b,n         perf_rdr_shift_out_W_leave
 978	nop
 979	ssm		0,0
 980	nop
 981
 982perf_rdr_shift_out_W_leave:
 983	bve		(%r2)
 984	.exit
 985	MTDIAG_2	(23)			; restore DR2
 986	.procend
 987ENDPROC(perf_rdr_shift_out_W)
 988
 989
 990;***********************************************************************
 991;*
 992;* Name: rdr_shift_in_U
 993;*
 994;* Description:
 995;*	This routine shifts data in from the RDR in arg0 and returns
 996;*	the result in ret0.  If the RDR is <= 64 bits in length, it
 997;*	is shifted shifted backup immediately.  This is to compensate
 998;*	for RDR10 which has bits that preclude PDC stack operations
 999;*	when they are in the wrong state.
1000;*
1001;* Arguments:
1002;*	arg0 : rdr to be read
1003;*	arg1 : bit length of rdr
1004;*
1005;* Returns:
1006;*	ret0 = next 64 bits of rdr data from staging register
1007;*
1008;* Register usage:
1009;*	arg0 : rdr to be read						                        
1010;*	arg1 : bit length of rdr					                        
1011;*	%r24 - original DR2 value
1012;*	%r23 - DR2 | DR2_SLOW_RET
1013;*	%r1  - scratch
1014;*
1015;***********************************************************************
1016
1017ENTRY(perf_rdr_shift_in_U)
1018	.proc
1019	.callinfo frame=0,NO_CALLS
1020	.entry
1021
1022; read(shift in) the RDR.
1023;
1024; NOTE: The PCX-U ERS states that DR2_SLOW_RET must be set before any
1025; shifting is done, from or to, remote diagnose registers.
1026
1027	depdi,z		1,DR2_SLOW_RET,1,%r29
1028	MFDIAG_2	(24)
1029	or			%r24,%r29,%r29
1030	MTDIAG_2	(29)			; set DR2_SLOW_RET
1031
1032	nop
1033	nop
1034	nop
1035	nop
1036
1037;
1038; Start of next 32-byte cacheline
1039;
1040	nop
1041	nop
1042	nop
1043	extrd,u		arg1,63,6,%r1
1044
1045	mtsar		%r1
1046	shladd		arg0,2,%r0,%r1	; %r1 = 4 * RDR number
1047	blr 		%r1,%r0		; branch to 8-instruction sequence
1048	nop
1049
1050;
1051; Start of next 32-byte cacheline
1052;
1053	SFDIAG		(0)		; RDR 0 read sequence
1054	ssm		0,0
1055	MFDIAG_1	(28)
1056	shrpd		ret0,%r0,%sar,%r1
1057	MTDIAG_1	(1)
1058	STDIAG		(0)
1059	ssm		0,0
1060	b,n         perf_rdr_shift_in_U_leave
1061
1062	SFDIAG		(1)		; RDR 1 read sequence
1063	ssm		0,0
1064	MFDIAG_1	(28)
1065	shrpd		ret0,%r0,%sar,%r1
1066	MTDIAG_1	(1)
1067	STDIAG		(1)
1068	ssm		0,0
1069	b,n         perf_rdr_shift_in_U_leave
1070
1071	sync				; RDR 2 read sequence
1072	ssm		0,0
1073	SFDIAG		(4)
1074	ssm		0,0
1075	MFDIAG_1	(28)
1076	b,n         perf_rdr_shift_in_U_leave
1077	ssm		0,0
1078	nop
1079
1080	sync				; RDR 3 read sequence
1081	ssm		0,0
1082	SFDIAG		(3)
1083	ssm		0,0
1084	MFDIAG_1	(28)
1085	b,n         perf_rdr_shift_in_U_leave
1086	ssm		0,0
1087	nop
1088
1089	sync				; RDR 4 read sequence
1090	ssm		0,0
1091	SFDIAG		(4)
1092	ssm		0,0
1093	MFDIAG_1	(28)
1094	b,n         perf_rdr_shift_in_U_leave
1095	ssm		0,0
1096	nop
1097
1098	sync				; RDR 5 read sequence
1099	ssm		0,0
1100	SFDIAG		(5)
1101	ssm		0,0
1102	MFDIAG_1	(28)
1103	b,n         perf_rdr_shift_in_U_leave
1104	ssm		0,0
1105	nop
1106
1107	sync				; RDR 6 read sequence
1108	ssm		0,0
1109	SFDIAG		(6)
1110	ssm		0,0
1111	MFDIAG_1	(28)
1112	b,n         perf_rdr_shift_in_U_leave
1113	ssm		0,0
1114	nop
1115
1116	sync				; RDR 7 read sequence
1117	ssm		0,0
1118	SFDIAG		(7)
1119	ssm		0,0
1120	MFDIAG_1	(28)
1121	b,n         perf_rdr_shift_in_U_leave
1122	ssm		0,0
1123	nop
1124
1125	b,n         perf_rdr_shift_in_U_leave
1126	nop
1127	nop
1128	nop
1129	nop
1130	nop
1131	nop
1132	nop
1133
1134	SFDIAG		(9)		; RDR 9 read sequence
1135	ssm		0,0
1136	MFDIAG_1	(28)
1137	shrpd		ret0,%r0,%sar,%r1
1138	MTDIAG_1	(1)
1139	STDIAG		(9)
1140	ssm		0,0
1141	b,n         perf_rdr_shift_in_U_leave
1142
1143	SFDIAG		(10)		; RDR 10 read sequence
1144	ssm		0,0
1145	MFDIAG_1	(28)
1146	shrpd		ret0,%r0,%sar,%r1
1147	MTDIAG_1	(1)
1148	STDIAG		(10)
1149	ssm		0,0
1150	b,n         perf_rdr_shift_in_U_leave
1151
1152	SFDIAG		(11)		; RDR 11 read sequence
1153	ssm		0,0
1154	MFDIAG_1	(28)
1155	shrpd		ret0,%r0,%sar,%r1
1156	MTDIAG_1	(1)
1157	STDIAG		(11)
1158	ssm		0,0
1159	b,n         perf_rdr_shift_in_U_leave
1160
1161	SFDIAG		(12)		; RDR 12 read sequence
1162	ssm		0,0
1163	MFDIAG_1	(28)
1164	shrpd		ret0,%r0,%sar,%r1
1165	MTDIAG_1	(1)
1166	STDIAG		(12)
1167	ssm		0,0
1168	b,n         perf_rdr_shift_in_U_leave
1169
1170	SFDIAG		(13)		; RDR 13 read sequence
1171	ssm		0,0
1172	MFDIAG_1	(28)
1173	shrpd		ret0,%r0,%sar,%r1
1174	MTDIAG_1	(1)
1175	STDIAG		(13)
1176	ssm		0,0
1177	b,n         perf_rdr_shift_in_U_leave
1178
1179	SFDIAG		(14)		; RDR 14 read sequence
1180	ssm		0,0
1181	MFDIAG_1	(28)
1182	shrpd		ret0,%r0,%sar,%r1
1183	MTDIAG_1	(1)
1184	STDIAG		(14)
1185	ssm		0,0
1186	b,n         perf_rdr_shift_in_U_leave
1187
1188	SFDIAG		(15)		; RDR 15 read sequence
1189	ssm		0,0
1190	MFDIAG_1	(28)
1191	shrpd		ret0,%r0,%sar,%r1
1192	MTDIAG_1	(1)
1193	STDIAG		(15)
1194	ssm		0,0
1195	b,n         perf_rdr_shift_in_U_leave
1196
1197	sync				; RDR 16 read sequence
1198	ssm		0,0
1199	SFDIAG		(16)
1200	ssm		0,0
1201	MFDIAG_1	(28)
1202	b,n         perf_rdr_shift_in_U_leave
1203	ssm		0,0
1204	nop
1205
1206	SFDIAG		(17)		; RDR 17 read sequence
1207	ssm		0,0
1208	MFDIAG_1	(28)
1209	shrpd		ret0,%r0,%sar,%r1
1210	MTDIAG_1	(1)
1211	STDIAG		(17)
1212	ssm		0,0
1213	b,n         perf_rdr_shift_in_U_leave
1214
1215	SFDIAG		(18)		; RDR 18 read sequence
1216	ssm		0,0
1217	MFDIAG_1	(28)
1218	shrpd		ret0,%r0,%sar,%r1
1219	MTDIAG_1	(1)
1220	STDIAG		(18)
1221	ssm		0,0
1222	b,n         perf_rdr_shift_in_U_leave
1223
1224	b,n         perf_rdr_shift_in_U_leave
1225	nop
1226	nop
1227	nop
1228	nop
1229	nop
1230	nop
1231	nop
1232
1233	sync				; RDR 20 read sequence
1234	ssm		0,0
1235	SFDIAG		(20)
1236	ssm		0,0
1237	MFDIAG_1	(28)
1238	b,n         perf_rdr_shift_in_U_leave
1239	ssm		0,0
1240	nop
1241
1242	sync				; RDR 21 read sequence
1243	ssm		0,0
1244	SFDIAG		(21)
1245	ssm		0,0
1246	MFDIAG_1	(28)
1247	b,n         perf_rdr_shift_in_U_leave
1248	ssm		0,0
1249	nop
1250
1251	sync				; RDR 22 read sequence
1252	ssm		0,0
1253	SFDIAG		(22)
1254	ssm		0,0
1255	MFDIAG_1	(28)
1256	b,n         perf_rdr_shift_in_U_leave
1257	ssm		0,0
1258	nop
1259
1260	sync				; RDR 23 read sequence
1261	ssm		0,0
1262	SFDIAG		(23)
1263	ssm		0,0
1264	MFDIAG_1	(28)
1265	b,n         perf_rdr_shift_in_U_leave
1266	ssm		0,0
1267	nop
1268
1269	sync				; RDR 24 read sequence
1270	ssm		0,0
1271	SFDIAG		(24)
1272	ssm		0,0
1273	MFDIAG_1	(28)
1274	b,n         perf_rdr_shift_in_U_leave
1275	ssm		0,0
1276	nop
1277
1278	sync				; RDR 25 read sequence
1279	ssm		0,0
1280	SFDIAG		(25)
1281	ssm		0,0
1282	MFDIAG_1	(28)
1283	b,n         perf_rdr_shift_in_U_leave
1284	ssm		0,0
1285	nop
1286
1287	SFDIAG		(26)		; RDR 26 read sequence
1288	ssm		0,0
1289	MFDIAG_1	(28)
1290	shrpd		ret0,%r0,%sar,%r1
1291	MTDIAG_1	(1)
1292	STDIAG		(26)
1293	ssm		0,0
1294	b,n         perf_rdr_shift_in_U_leave
1295
1296	SFDIAG		(27)		; RDR 27 read sequence
1297	ssm		0,0
1298	MFDIAG_1	(28)
1299	shrpd		ret0,%r0,%sar,%r1
1300	MTDIAG_1	(1)
1301	STDIAG		(27)
1302	ssm		0,0
1303	b,n         perf_rdr_shift_in_U_leave
1304
1305	sync				; RDR 28 read sequence
1306	ssm		0,0
1307	SFDIAG		(28)
1308	ssm		0,0
1309	MFDIAG_1	(28)
1310	b,n         perf_rdr_shift_in_U_leave
1311	ssm		0,0
1312	nop
1313
1314	b,n         perf_rdr_shift_in_U_leave
1315	nop
1316	nop
1317	nop
1318	nop
1319	nop
1320	nop
1321	nop
1322
1323	SFDIAG		(30)		; RDR 30 read sequence
1324	ssm		0,0
1325	MFDIAG_1	(28)
1326	shrpd		ret0,%r0,%sar,%r1
1327	MTDIAG_1	(1)
1328	STDIAG		(30)
1329	ssm		0,0
1330	b,n         perf_rdr_shift_in_U_leave
1331
1332	SFDIAG		(31)		; RDR 31 read sequence
1333	ssm		0,0
1334	MFDIAG_1	(28)
1335	shrpd		ret0,%r0,%sar,%r1
1336	MTDIAG_1	(1)
1337	STDIAG		(31)
1338	ssm		0,0
1339	b,n         perf_rdr_shift_in_U_leave
1340	nop
1341
1342perf_rdr_shift_in_U_leave:
1343	bve		    (%r2)
1344	.exit
1345	MTDIAG_2	(24)			; restore DR2
1346	.procend
1347ENDPROC(perf_rdr_shift_in_U)
1348
1349;***********************************************************************
1350;*
1351;* Name: rdr_shift_out_U
1352;*
1353;* Description:
1354;*	This routine moves data to the RDR's.  The double-word that
1355;*	arg1 points to is loaded and moved into the staging register.
1356;*	Then the STDIAG instruction for the RDR # in arg0 is called
1357;*	to move the data to the RDR.
1358;*
1359;* Arguments:
1360;*	arg0 = rdr target
1361;*	arg1 = buffer pointer
1362;*
1363;* Returns:
1364;*	None
1365;*
1366;* Register usage:
1367;*	arg0 = rdr target
1368;*	arg1 = buffer pointer
1369;*	%r24 - DR2 | DR2_SLOW_RET
1370;*	%r23 - original DR2 value
1371;*
1372;***********************************************************************
1373
1374ENTRY(perf_rdr_shift_out_U)
1375	.proc
1376	.callinfo frame=0,NO_CALLS
1377	.entry
1378
1379;
1380; NOTE: The PCX-U ERS states that DR2_SLOW_RET must be set before any
1381; shifting is done, from or to, the remote diagnose registers.
1382;
1383
1384	depdi,z		1,DR2_SLOW_RET,1,%r24
1385	MFDIAG_2	(23)
1386	or		%r24,%r23,%r24
1387	MTDIAG_2	(24)		; set DR2_SLOW_RET
1388
1389	MTDIAG_1	(25)		; data to the staging register
1390	shladd		arg0,2,%r0,%r1	; %r1 = 4 * RDR number
1391	blr		%r1,%r0		; branch to 8-instruction sequence
1392	nop
1393
1394;
1395; 32-byte cachline aligned
1396;
1397
1398	sync				; RDR 0 write sequence
1399	ssm		0,0
1400	STDIAG		(0)
1401	ssm		0,0
1402	b,n         perf_rdr_shift_out_U_leave
1403	nop
1404	ssm		0,0
1405	nop
1406
1407	sync				; RDR 1 write sequence
1408	ssm		0,0
1409	STDIAG		(1)
1410	ssm		0,0
1411	b,n         perf_rdr_shift_out_U_leave
1412	nop
1413	ssm		0,0
1414	nop
1415
1416	sync				; RDR 2 write sequence
1417	ssm		0,0
1418	STDIAG		(2)
1419	ssm		0,0
1420	b,n         perf_rdr_shift_out_U_leave
1421	nop
1422	ssm		0,0
1423	nop
1424
1425	sync				; RDR 3 write sequence
1426	ssm		0,0
1427	STDIAG		(3)
1428	ssm		0,0
1429	b,n         perf_rdr_shift_out_U_leave
1430	nop
1431	ssm		0,0
1432	nop
1433
1434	sync				; RDR 4 write sequence
1435	ssm		0,0
1436	STDIAG		(4)
1437	ssm		0,0
1438	b,n         perf_rdr_shift_out_U_leave
1439	nop
1440	ssm		0,0
1441	nop
1442
1443	sync				; RDR 5 write sequence
1444	ssm		0,0
1445	STDIAG		(5)
1446	ssm		0,0
1447	b,n         perf_rdr_shift_out_U_leave
1448	nop
1449	ssm		0,0
1450	nop
1451
1452	sync				; RDR 6 write sequence
1453	ssm		0,0
1454	STDIAG		(6)
1455	ssm		0,0
1456	b,n         perf_rdr_shift_out_U_leave
1457	nop
1458	ssm		0,0
1459	nop
1460
1461	sync				; RDR 7 write sequence
1462	ssm		0,0
1463	STDIAG		(7)
1464	ssm		0,0
1465	b,n         perf_rdr_shift_out_U_leave
1466	nop
1467	ssm		0,0
1468	nop
1469
1470	sync				; RDR 8 write sequence
1471	ssm		0,0
1472	STDIAG		(8)
1473	ssm		0,0
1474	b,n         perf_rdr_shift_out_U_leave
1475	nop
1476	ssm		0,0
1477	nop
1478
1479	sync				; RDR 9 write sequence
1480	ssm		0,0
1481	STDIAG		(9)
1482	ssm		0,0
1483	b,n         perf_rdr_shift_out_U_leave
1484	nop
1485	ssm		0,0
1486	nop
1487
1488	sync				; RDR 10 write sequence
1489	ssm		0,0
1490	STDIAG		(10)
1491	ssm		0,0
1492	b,n         perf_rdr_shift_out_U_leave
1493	nop
1494	ssm		0,0
1495	nop
1496
1497	sync				; RDR 11 write sequence
1498	ssm		0,0
1499	STDIAG		(11)
1500	ssm		0,0
1501	b,n         perf_rdr_shift_out_U_leave
1502	nop
1503	ssm		0,0
1504	nop
1505
1506	sync				; RDR 12 write sequence
1507	ssm		0,0
1508	STDIAG		(12)
1509	ssm		0,0
1510	b,n         perf_rdr_shift_out_U_leave
1511	nop
1512	ssm		0,0
1513	nop
1514
1515	sync				; RDR 13 write sequence
1516	ssm		0,0
1517	STDIAG		(13)
1518	ssm		0,0
1519	b,n         perf_rdr_shift_out_U_leave
1520	nop
1521	ssm		0,0
1522	nop
1523
1524	sync				; RDR 14 write sequence
1525	ssm		0,0
1526	STDIAG		(14)
1527	ssm		0,0
1528	b,n         perf_rdr_shift_out_U_leave
1529	nop
1530	ssm		0,0
1531	nop
1532
1533	sync				; RDR 15 write sequence
1534	ssm		0,0
1535	STDIAG		(15)
1536	ssm		0,0
1537	b,n         perf_rdr_shift_out_U_leave
1538	nop
1539	ssm		0,0
1540	nop
1541
1542	sync				; RDR 16 write sequence
1543	ssm		0,0
1544	STDIAG		(16)
1545	ssm		0,0
1546	b,n         perf_rdr_shift_out_U_leave
1547	nop
1548	ssm		0,0
1549	nop
1550
1551	sync				; RDR 17 write sequence
1552	ssm		0,0
1553	STDIAG		(17)
1554	ssm		0,0
1555	b,n         perf_rdr_shift_out_U_leave
1556	nop
1557	ssm		0,0
1558	nop
1559
1560	sync				; RDR 18 write sequence
1561	ssm		0,0
1562	STDIAG		(18)
1563	ssm		0,0
1564	b,n         perf_rdr_shift_out_U_leave
1565	nop
1566	ssm		0,0
1567	nop
1568
1569	sync				; RDR 19 write sequence
1570	ssm		0,0
1571	STDIAG		(19)
1572	ssm		0,0
1573	b,n         perf_rdr_shift_out_U_leave
1574	nop
1575	ssm		0,0
1576	nop
1577
1578	sync				; RDR 20 write sequence
1579	ssm		0,0
1580	STDIAG		(20)
1581	ssm		0,0
1582	b,n         perf_rdr_shift_out_U_leave
1583	nop
1584	ssm		0,0
1585	nop
1586
1587	sync				; RDR 21 write sequence
1588	ssm		0,0
1589	STDIAG		(21)
1590	ssm		0,0
1591	b,n         perf_rdr_shift_out_U_leave
1592	nop
1593	ssm		0,0
1594	nop
1595
1596	sync				; RDR 22 write sequence
1597	ssm		0,0
1598	STDIAG		(22)
1599	ssm		0,0
1600	b,n         perf_rdr_shift_out_U_leave
1601	nop
1602	ssm		0,0
1603	nop
1604
1605	sync				; RDR 23 write sequence
1606	ssm		0,0
1607	STDIAG		(23)
1608	ssm		0,0
1609	b,n         perf_rdr_shift_out_U_leave
1610	nop
1611	ssm		0,0
1612	nop
1613
1614	sync				; RDR 24 write sequence
1615	ssm		0,0
1616	STDIAG		(24)
1617	ssm		0,0
1618	b,n         perf_rdr_shift_out_U_leave
1619	nop
1620	ssm		0,0
1621	nop
1622
1623	sync				; RDR 25 write sequence
1624	ssm		0,0
1625	STDIAG		(25)
1626	ssm		0,0
1627	b,n         perf_rdr_shift_out_U_leave
1628	nop
1629	ssm		0,0
1630	nop
1631
1632	sync				; RDR 26 write sequence
1633	ssm		0,0
1634	STDIAG		(26)
1635	ssm		0,0
1636	b,n         perf_rdr_shift_out_U_leave
1637	nop
1638	ssm		0,0
1639	nop
1640
1641	sync				; RDR 27 write sequence
1642	ssm		0,0
1643	STDIAG		(27)
1644	ssm		0,0
1645	b,n         perf_rdr_shift_out_U_leave
1646	nop
1647	ssm		0,0
1648	nop
1649
1650	sync				; RDR 28 write sequence
1651	ssm		0,0
1652	STDIAG		(28)
1653	ssm		0,0
1654	b,n         perf_rdr_shift_out_U_leave
1655	nop
1656	ssm		0,0
1657	nop
1658
1659	sync				; RDR 29 write sequence
1660	ssm		0,0
1661	STDIAG		(29)
1662	ssm		0,0
1663	b,n         perf_rdr_shift_out_U_leave
1664	nop
1665	ssm		0,0
1666	nop
1667
1668	sync				; RDR 30 write sequence
1669	ssm		0,0
1670	STDIAG		(30)
1671	ssm		0,0
1672	b,n         perf_rdr_shift_out_U_leave
1673	nop
1674	ssm		0,0
1675	nop
1676
1677	sync				; RDR 31 write sequence
1678	ssm		0,0
1679	STDIAG		(31)
1680	ssm		0,0
1681	b,n         perf_rdr_shift_out_U_leave
1682	nop
1683	ssm		0,0
1684	nop
1685
1686perf_rdr_shift_out_U_leave:
1687	bve		(%r2)
1688	.exit
1689	MTDIAG_2	(23)			; restore DR2
1690	.procend
1691ENDPROC(perf_rdr_shift_out_U)
1692