xref: /illumos-gate/usr/src/uts/sun4/os/visinstr.c (revision b1b05f9e1bfd7565476102e5bfbf10316fe6d0b8)
17c478bd9Sstevel@tonic-gate /*
27c478bd9Sstevel@tonic-gate  * CDDL HEADER START
37c478bd9Sstevel@tonic-gate  *
47c478bd9Sstevel@tonic-gate  * The contents of this file are subject to the terms of the
5428cee1bSjfrank  * Common Development and Distribution License (the "License").
6428cee1bSjfrank  * You may not use this file except in compliance with the License.
77c478bd9Sstevel@tonic-gate  *
87c478bd9Sstevel@tonic-gate  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
97c478bd9Sstevel@tonic-gate  * or http://www.opensolaris.org/os/licensing.
107c478bd9Sstevel@tonic-gate  * See the License for the specific language governing permissions
117c478bd9Sstevel@tonic-gate  * and limitations under the License.
127c478bd9Sstevel@tonic-gate  *
137c478bd9Sstevel@tonic-gate  * When distributing Covered Code, include this CDDL HEADER in each
147c478bd9Sstevel@tonic-gate  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
157c478bd9Sstevel@tonic-gate  * If applicable, add the following below this CDDL HEADER, with the
167c478bd9Sstevel@tonic-gate  * fields enclosed by brackets "[]" replaced with your own identifying
177c478bd9Sstevel@tonic-gate  * information: Portions Copyright [yyyy] [name of copyright owner]
187c478bd9Sstevel@tonic-gate  *
197c478bd9Sstevel@tonic-gate  * CDDL HEADER END
207c478bd9Sstevel@tonic-gate  */
217c478bd9Sstevel@tonic-gate /*
225ccb2ff8Swh  * Copyright 2007 Sun Microsystems, Inc.  All rights reserved.
237c478bd9Sstevel@tonic-gate  * Use is subject to license terms.
247c478bd9Sstevel@tonic-gate  */
257c478bd9Sstevel@tonic-gate 
267c478bd9Sstevel@tonic-gate #pragma ident	"%Z%%M%	%I%	%E% SMI"
277c478bd9Sstevel@tonic-gate 
287c478bd9Sstevel@tonic-gate /* VIS floating point instruction simulator for Sparc FPU simulator. */
297c478bd9Sstevel@tonic-gate 
307c478bd9Sstevel@tonic-gate #include <sys/types.h>
317c478bd9Sstevel@tonic-gate #include <sys/systm.h>
327c478bd9Sstevel@tonic-gate #include <sys/fpu/fpusystm.h>
337c478bd9Sstevel@tonic-gate #include <sys/fpu/fpu_simulator.h>
347c478bd9Sstevel@tonic-gate #include <sys/vis_simulator.h>
357c478bd9Sstevel@tonic-gate #include <sys/fpu/globals.h>
367c478bd9Sstevel@tonic-gate #include <sys/privregs.h>
377c478bd9Sstevel@tonic-gate #include <sys/sun4asi.h>
387c478bd9Sstevel@tonic-gate #include <sys/machasi.h>
397c478bd9Sstevel@tonic-gate #include <sys/debug.h>
407c478bd9Sstevel@tonic-gate #include <sys/cpu_module.h>
417c478bd9Sstevel@tonic-gate #include <sys/systm.h>
427c478bd9Sstevel@tonic-gate 
437c478bd9Sstevel@tonic-gate #define	FPU_REG_FIELD uint32_reg	/* Coordinate with FPU_REGS_TYPE. */
447c478bd9Sstevel@tonic-gate #define	FPU_DREG_FIELD uint64_reg	/* Coordinate with FPU_DREGS_TYPE. */
457c478bd9Sstevel@tonic-gate #define	FPU_FSR_FIELD uint64_reg	/* Coordinate with V9_FPU_FSR_TYPE. */
467c478bd9Sstevel@tonic-gate 
47bfb7f382Skalai extern	uint_t	get_subcc_ccr(uint64_t, uint64_t);
48bfb7f382Skalai 
497c478bd9Sstevel@tonic-gate static enum ftt_type vis_array(fp_simd_type *, vis_inst_type, struct regs *,
507c478bd9Sstevel@tonic-gate 				void *);
517c478bd9Sstevel@tonic-gate static enum ftt_type vis_alignaddr(fp_simd_type *, vis_inst_type,
527c478bd9Sstevel@tonic-gate 				struct regs *, void *, kfpu_t *);
537c478bd9Sstevel@tonic-gate static enum ftt_type vis_edge(fp_simd_type *, vis_inst_type, struct regs *,
547c478bd9Sstevel@tonic-gate 				void *);
557c478bd9Sstevel@tonic-gate static enum ftt_type vis_faligndata(fp_simd_type *, fp_inst_type,
567c478bd9Sstevel@tonic-gate 				kfpu_t *);
577c478bd9Sstevel@tonic-gate static enum ftt_type vis_bmask(fp_simd_type *, vis_inst_type, struct regs *,
587c478bd9Sstevel@tonic-gate 				void *, kfpu_t *);
597c478bd9Sstevel@tonic-gate static enum ftt_type vis_bshuffle(fp_simd_type *, fp_inst_type,
607c478bd9Sstevel@tonic-gate 				kfpu_t *);
617c478bd9Sstevel@tonic-gate static enum ftt_type vis_siam(fp_simd_type *, vis_inst_type, kfpu_t *);
627c478bd9Sstevel@tonic-gate static enum ftt_type vis_fcmp(fp_simd_type *, vis_inst_type, struct regs *,
637c478bd9Sstevel@tonic-gate 				void *);
647c478bd9Sstevel@tonic-gate static enum ftt_type vis_fmul(fp_simd_type *, vis_inst_type);
657c478bd9Sstevel@tonic-gate static enum ftt_type vis_fpixel(fp_simd_type *, vis_inst_type, kfpu_t *);
667c478bd9Sstevel@tonic-gate static enum ftt_type vis_fpaddsub(fp_simd_type *, vis_inst_type);
677c478bd9Sstevel@tonic-gate static enum ftt_type vis_pdist(fp_simd_type *, fp_inst_type);
687c478bd9Sstevel@tonic-gate static enum ftt_type vis_prtl_fst(fp_simd_type *, vis_inst_type, struct regs *,
697c478bd9Sstevel@tonic-gate 				void *, uint_t);
707c478bd9Sstevel@tonic-gate static enum ftt_type vis_short_fls(fp_simd_type *, vis_inst_type,
717c478bd9Sstevel@tonic-gate 				struct regs *, void *, uint_t);
727c478bd9Sstevel@tonic-gate static enum ftt_type vis_blk_fldst(fp_simd_type *, vis_inst_type,
737c478bd9Sstevel@tonic-gate 				struct regs *, void *, uint_t);
747c478bd9Sstevel@tonic-gate 
757c478bd9Sstevel@tonic-gate /*
767c478bd9Sstevel@tonic-gate  * Simulator for VIS instructions with op3 == 0x36 that get fp_disabled
777c478bd9Sstevel@tonic-gate  * traps.
787c478bd9Sstevel@tonic-gate  */
797c478bd9Sstevel@tonic-gate enum ftt_type
807c478bd9Sstevel@tonic-gate vis_fpu_simulator(
817c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
827c478bd9Sstevel@tonic-gate 	fp_inst_type	pinst,	/* FPU instruction to simulate. */
837c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
847c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
857c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
867c478bd9Sstevel@tonic-gate {
877c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
887c478bd9Sstevel@tonic-gate 	uint_t	us1, us2, usr;
897c478bd9Sstevel@tonic-gate 	uint64_t lus1, lus2, lusr;
907c478bd9Sstevel@tonic-gate 	enum ftt_type ftt = ftt_none;
917c478bd9Sstevel@tonic-gate 	union {
927c478bd9Sstevel@tonic-gate 		vis_inst_type	inst;
937c478bd9Sstevel@tonic-gate 		fp_inst_type	pinst;
947c478bd9Sstevel@tonic-gate 	} f;
957c478bd9Sstevel@tonic-gate 
967c478bd9Sstevel@tonic-gate 	ASSERT(USERMODE(pregs->r_tstate));
977c478bd9Sstevel@tonic-gate 	nrs1 = pinst.rs1;
987c478bd9Sstevel@tonic-gate 	nrs2 = pinst.rs2;
997c478bd9Sstevel@tonic-gate 	nrd = pinst.rd;
1007c478bd9Sstevel@tonic-gate 	f.pinst = pinst;
1017c478bd9Sstevel@tonic-gate 	if ((f.inst.opf & 1) == 0) {		/* double precision */
1027c478bd9Sstevel@tonic-gate 		if ((nrs1 & 1) == 1) 		/* fix register encoding */
1037c478bd9Sstevel@tonic-gate 			nrs1 = (nrs1 & 0x1e) | 0x20;
1047c478bd9Sstevel@tonic-gate 		if ((nrs2 & 1) == 1)
1057c478bd9Sstevel@tonic-gate 			nrs2 = (nrs2 & 0x1e) | 0x20;
1067c478bd9Sstevel@tonic-gate 		if ((nrd & 1) == 1)
1077c478bd9Sstevel@tonic-gate 			nrd = (nrd & 0x1e) | 0x20;
1087c478bd9Sstevel@tonic-gate 	}
1097c478bd9Sstevel@tonic-gate 
1107c478bd9Sstevel@tonic-gate 	switch (f.inst.opf) {
1117c478bd9Sstevel@tonic-gate 		/* these instr's do not use fp regs */
1127c478bd9Sstevel@tonic-gate 	case edge8:
1137c478bd9Sstevel@tonic-gate 	case edge8l:
1147c478bd9Sstevel@tonic-gate 	case edge8n:
1157c478bd9Sstevel@tonic-gate 	case edge8ln:
1167c478bd9Sstevel@tonic-gate 	case edge16:
1177c478bd9Sstevel@tonic-gate 	case edge16l:
1187c478bd9Sstevel@tonic-gate 	case edge16n:
1197c478bd9Sstevel@tonic-gate 	case edge16ln:
1207c478bd9Sstevel@tonic-gate 	case edge32:
1217c478bd9Sstevel@tonic-gate 	case edge32l:
1227c478bd9Sstevel@tonic-gate 	case edge32n:
1237c478bd9Sstevel@tonic-gate 	case edge32ln:
1247c478bd9Sstevel@tonic-gate 		ftt = vis_edge(pfpsd, f.inst, pregs, prw);
1257c478bd9Sstevel@tonic-gate 		break;
1267c478bd9Sstevel@tonic-gate 	case array8:
1277c478bd9Sstevel@tonic-gate 	case array16:
1287c478bd9Sstevel@tonic-gate 	case array32:
1297c478bd9Sstevel@tonic-gate 		ftt = vis_array(pfpsd, f.inst, pregs, prw);
1307c478bd9Sstevel@tonic-gate 		break;
1317c478bd9Sstevel@tonic-gate 	case alignaddr:
1327c478bd9Sstevel@tonic-gate 	case alignaddrl:
1337c478bd9Sstevel@tonic-gate 		ftt = vis_alignaddr(pfpsd, f.inst, pregs, prw, fp);
1347c478bd9Sstevel@tonic-gate 		break;
1357c478bd9Sstevel@tonic-gate 	case bmask:
1367c478bd9Sstevel@tonic-gate 		ftt = vis_bmask(pfpsd, f.inst, pregs, prw, fp);
1377c478bd9Sstevel@tonic-gate 		break;
1387c478bd9Sstevel@tonic-gate 	case fcmple16:
1397c478bd9Sstevel@tonic-gate 	case fcmpne16:
1407c478bd9Sstevel@tonic-gate 	case fcmpgt16:
1417c478bd9Sstevel@tonic-gate 	case fcmpeq16:
1427c478bd9Sstevel@tonic-gate 	case fcmple32:
1437c478bd9Sstevel@tonic-gate 	case fcmpne32:
1447c478bd9Sstevel@tonic-gate 	case fcmpgt32:
1457c478bd9Sstevel@tonic-gate 	case fcmpeq32:
1467c478bd9Sstevel@tonic-gate 		ftt = vis_fcmp(pfpsd, f.inst, pregs, prw);
1477c478bd9Sstevel@tonic-gate 		break;
1487c478bd9Sstevel@tonic-gate 	case fmul8x16:
1497c478bd9Sstevel@tonic-gate 	case fmul8x16au:
1507c478bd9Sstevel@tonic-gate 	case fmul8x16al:
1517c478bd9Sstevel@tonic-gate 	case fmul8sux16:
1527c478bd9Sstevel@tonic-gate 	case fmul8ulx16:
1537c478bd9Sstevel@tonic-gate 	case fmuld8sux16:
1547c478bd9Sstevel@tonic-gate 	case fmuld8ulx16:
1557c478bd9Sstevel@tonic-gate 		ftt = vis_fmul(pfpsd, f.inst);
1567c478bd9Sstevel@tonic-gate 		break;
1577c478bd9Sstevel@tonic-gate 	case fpack16:
1587c478bd9Sstevel@tonic-gate 	case fpack32:
1597c478bd9Sstevel@tonic-gate 	case fpackfix:
1607c478bd9Sstevel@tonic-gate 	case fexpand:
1617c478bd9Sstevel@tonic-gate 	case fpmerge:
1627c478bd9Sstevel@tonic-gate 		ftt = vis_fpixel(pfpsd, f.inst, fp);
1637c478bd9Sstevel@tonic-gate 		break;
1647c478bd9Sstevel@tonic-gate 	case pdist:
1657c478bd9Sstevel@tonic-gate 		ftt = vis_pdist(pfpsd, pinst);
1667c478bd9Sstevel@tonic-gate 		break;
1677c478bd9Sstevel@tonic-gate 	case faligndata:
1687c478bd9Sstevel@tonic-gate 		ftt = vis_faligndata(pfpsd, pinst, fp);
1697c478bd9Sstevel@tonic-gate 		break;
1707c478bd9Sstevel@tonic-gate 	case bshuffle:
1717c478bd9Sstevel@tonic-gate 		ftt = vis_bshuffle(pfpsd, pinst, fp);
1727c478bd9Sstevel@tonic-gate 		break;
1737c478bd9Sstevel@tonic-gate 	case fpadd16:
1747c478bd9Sstevel@tonic-gate 	case fpadd16s:
1757c478bd9Sstevel@tonic-gate 	case fpadd32:
1767c478bd9Sstevel@tonic-gate 	case fpadd32s:
1777c478bd9Sstevel@tonic-gate 	case fpsub16:
1787c478bd9Sstevel@tonic-gate 	case fpsub16s:
1797c478bd9Sstevel@tonic-gate 	case fpsub32:
1807c478bd9Sstevel@tonic-gate 	case fpsub32s:
1817c478bd9Sstevel@tonic-gate 		ftt = vis_fpaddsub(pfpsd, f.inst);
1827c478bd9Sstevel@tonic-gate 		break;
1837c478bd9Sstevel@tonic-gate 	case fzero:
1847c478bd9Sstevel@tonic-gate 		lusr = 0;
1857c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
1867c478bd9Sstevel@tonic-gate 		break;
1877c478bd9Sstevel@tonic-gate 	case fzeros:
1887c478bd9Sstevel@tonic-gate 		usr = 0;
1897c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
1907c478bd9Sstevel@tonic-gate 		break;
1917c478bd9Sstevel@tonic-gate 	case fnor:
1927c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
1937c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
1947c478bd9Sstevel@tonic-gate 		lusr = ~(lus1 | lus2);
1957c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
1967c478bd9Sstevel@tonic-gate 		break;
1977c478bd9Sstevel@tonic-gate 	case fnors:
1987c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
1997c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
2007c478bd9Sstevel@tonic-gate 		usr = ~(us1 | us2);
2017c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2027c478bd9Sstevel@tonic-gate 		break;
2037c478bd9Sstevel@tonic-gate 	case fandnot2:
2047c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
2057c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
2067c478bd9Sstevel@tonic-gate 		lusr = (lus1 & ~lus2);
2077c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2087c478bd9Sstevel@tonic-gate 		break;
2097c478bd9Sstevel@tonic-gate 	case fandnot2s:
2107c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
2117c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
2127c478bd9Sstevel@tonic-gate 		usr = (us1 & ~us2);
2137c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2147c478bd9Sstevel@tonic-gate 		break;
2157c478bd9Sstevel@tonic-gate 	case fnot2:
2167c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
2177c478bd9Sstevel@tonic-gate 		lusr = ~lus2;
2187c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2197c478bd9Sstevel@tonic-gate 		break;
2207c478bd9Sstevel@tonic-gate 	case fnot2s:
2217c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
2227c478bd9Sstevel@tonic-gate 		usr = ~us2;
2237c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2247c478bd9Sstevel@tonic-gate 		break;
2257c478bd9Sstevel@tonic-gate 	case fandnot1:
2267c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
2277c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
2287c478bd9Sstevel@tonic-gate 		lusr = (~lus1 & lus2);
2297c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2307c478bd9Sstevel@tonic-gate 		break;
2317c478bd9Sstevel@tonic-gate 	case fandnot1s:
2327c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
2337c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
2347c478bd9Sstevel@tonic-gate 		usr = (~us1 & us2);
2357c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2367c478bd9Sstevel@tonic-gate 		break;
2377c478bd9Sstevel@tonic-gate 	case fnot1:
2387c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
2397c478bd9Sstevel@tonic-gate 		lusr = ~lus1;
2407c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2417c478bd9Sstevel@tonic-gate 		break;
2427c478bd9Sstevel@tonic-gate 	case fnot1s:
2437c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
2447c478bd9Sstevel@tonic-gate 		usr = ~us1;
2457c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2467c478bd9Sstevel@tonic-gate 		break;
2477c478bd9Sstevel@tonic-gate 	case fxor:
2487c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
2497c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
2507c478bd9Sstevel@tonic-gate 		lusr = (lus1 ^ lus2);
2517c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2527c478bd9Sstevel@tonic-gate 		break;
2537c478bd9Sstevel@tonic-gate 	case fxors:
2547c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
2557c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
2567c478bd9Sstevel@tonic-gate 		usr = (us1 ^ us2);
2577c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2587c478bd9Sstevel@tonic-gate 		break;
2597c478bd9Sstevel@tonic-gate 	case fnand:
2607c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
2617c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
2627c478bd9Sstevel@tonic-gate 		lusr = ~(lus1 & lus2);
2637c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2647c478bd9Sstevel@tonic-gate 		break;
2657c478bd9Sstevel@tonic-gate 	case fnands:
2667c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
2677c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
2687c478bd9Sstevel@tonic-gate 		usr = ~(us1 & us2);
2697c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2707c478bd9Sstevel@tonic-gate 		break;
2717c478bd9Sstevel@tonic-gate 	case fand:
2727c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
2737c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
2747c478bd9Sstevel@tonic-gate 		lusr = (lus1 & lus2);
2757c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2767c478bd9Sstevel@tonic-gate 		break;
2777c478bd9Sstevel@tonic-gate 	case fands:
2787c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
2797c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
2807c478bd9Sstevel@tonic-gate 		usr = (us1 & us2);
2817c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2827c478bd9Sstevel@tonic-gate 		break;
2837c478bd9Sstevel@tonic-gate 	case fxnor:
2847c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
2857c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
2867c478bd9Sstevel@tonic-gate 		lusr = ~(lus1 ^ lus2);
2877c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2887c478bd9Sstevel@tonic-gate 		break;
2897c478bd9Sstevel@tonic-gate 	case fxnors:
2907c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
2917c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
2927c478bd9Sstevel@tonic-gate 		usr = ~(us1 ^ us2);
2937c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
2947c478bd9Sstevel@tonic-gate 		break;
2957c478bd9Sstevel@tonic-gate 	case fsrc1:
2967c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lusr, nrs1);
2977c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
2987c478bd9Sstevel@tonic-gate 		break;
2997c478bd9Sstevel@tonic-gate 	case fsrc1s:
3007c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &usr, nrs1);
3017c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
3027c478bd9Sstevel@tonic-gate 		break;
3037c478bd9Sstevel@tonic-gate 	case fornot2:
3047c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
3057c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
3067c478bd9Sstevel@tonic-gate 		lusr = (lus1 | ~lus2);
3077c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
3087c478bd9Sstevel@tonic-gate 		break;
3097c478bd9Sstevel@tonic-gate 	case fornot2s:
3107c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
3117c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
3127c478bd9Sstevel@tonic-gate 		usr = (us1 | ~us2);
3137c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
3147c478bd9Sstevel@tonic-gate 		break;
3157c478bd9Sstevel@tonic-gate 	case fsrc2:
3167c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lusr, nrs2);
3177c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
3187c478bd9Sstevel@tonic-gate 		break;
3197c478bd9Sstevel@tonic-gate 	case fsrc2s:
3207c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &usr, nrs2);
3217c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
3227c478bd9Sstevel@tonic-gate 		break;
3237c478bd9Sstevel@tonic-gate 	case fornot1:
3247c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
3257c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
3267c478bd9Sstevel@tonic-gate 		lusr = (~lus1 | lus2);
3277c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
3287c478bd9Sstevel@tonic-gate 		break;
3297c478bd9Sstevel@tonic-gate 	case fornot1s:
3307c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
3317c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
3327c478bd9Sstevel@tonic-gate 		usr = (~us1 | us2);
3337c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
3347c478bd9Sstevel@tonic-gate 		break;
3357c478bd9Sstevel@tonic-gate 	case for_op:
3367c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus1, nrs1);
3377c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lus2, nrs2);
3387c478bd9Sstevel@tonic-gate 		lusr = (lus1 | lus2);
3397c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
3407c478bd9Sstevel@tonic-gate 		break;
3417c478bd9Sstevel@tonic-gate 	case fors_op:
3427c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us1, nrs1);
3437c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &us2, nrs2);
3447c478bd9Sstevel@tonic-gate 		usr = (us1 | us2);
3457c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
3467c478bd9Sstevel@tonic-gate 		break;
3477c478bd9Sstevel@tonic-gate 	case fone:
3487c478bd9Sstevel@tonic-gate 		lusr = 0xffffffffffffffff;
3497c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lusr, nrd);
3507c478bd9Sstevel@tonic-gate 		break;
3517c478bd9Sstevel@tonic-gate 	case fones:
3527c478bd9Sstevel@tonic-gate 		usr = 0xffffffffUL;
3537c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &usr, nrd);
3547c478bd9Sstevel@tonic-gate 		break;
3557c478bd9Sstevel@tonic-gate 	case siam:
3567c478bd9Sstevel@tonic-gate 		ftt = vis_siam(pfpsd, f.inst, fp);
3577c478bd9Sstevel@tonic-gate 		break;
3587c478bd9Sstevel@tonic-gate 	default:
3597c478bd9Sstevel@tonic-gate 		return (ftt_unimplemented);
3607c478bd9Sstevel@tonic-gate 	}
3617c478bd9Sstevel@tonic-gate 
3627c478bd9Sstevel@tonic-gate 	pregs->r_pc = pregs->r_npc;	/* Do not retry emulated instruction. */
3637c478bd9Sstevel@tonic-gate 	pregs->r_npc += 4;
3647c478bd9Sstevel@tonic-gate 	return (ftt);
3657c478bd9Sstevel@tonic-gate }
3667c478bd9Sstevel@tonic-gate 
3677c478bd9Sstevel@tonic-gate /*
3687c478bd9Sstevel@tonic-gate  * Simulator for edge instructions
3697c478bd9Sstevel@tonic-gate  */
3707c478bd9Sstevel@tonic-gate static enum ftt_type
3717c478bd9Sstevel@tonic-gate vis_edge(
3727c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
3737c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* FPU instruction to simulate. */
3747c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
3757c478bd9Sstevel@tonic-gate 	void		*prw)	/* Pointer to locals and ins. */
3767c478bd9Sstevel@tonic-gate 
3777c478bd9Sstevel@tonic-gate {
3787c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
3797c478bd9Sstevel@tonic-gate 	enum ftt_type ftt;
3807c478bd9Sstevel@tonic-gate 	uint64_t addrl, addrr, mask;
3817c478bd9Sstevel@tonic-gate 	uint64_t ah61l, ah61r;		/* Higher 61 bits of address */
3827c478bd9Sstevel@tonic-gate 	int al3l, al3r;			/* Lower 3 bits of address */
383bfb7f382Skalai 	uint_t	ccr;
3847c478bd9Sstevel@tonic-gate 
3857c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
3867c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
3877c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
3887c478bd9Sstevel@tonic-gate 
3897c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs1, pregs, prw, &addrl);
3907c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
3917c478bd9Sstevel@tonic-gate 		return (ftt);
3927c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs2, pregs, prw, &addrr);
3937c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
3947c478bd9Sstevel@tonic-gate 		return (ftt);
3957c478bd9Sstevel@tonic-gate 
396*b1b05f9eSarutz 	/* Test PSTATE.AM to determine 32-bit vs 64-bit addressing */
397*b1b05f9eSarutz 	if ((pregs->r_tstate & TSTATE_AM) != 0) {
398*b1b05f9eSarutz 		ah61l = addrl & 0xfffffff8;
399*b1b05f9eSarutz 		ah61r = addrr & 0xfffffff8;
4007c478bd9Sstevel@tonic-gate 	} else {
4017c478bd9Sstevel@tonic-gate 		ah61l = addrl & ~0x7;
4027c478bd9Sstevel@tonic-gate 		ah61r = addrr & ~0x7;
4037c478bd9Sstevel@tonic-gate 	}
4047c478bd9Sstevel@tonic-gate 
4057c478bd9Sstevel@tonic-gate 
4067c478bd9Sstevel@tonic-gate 	switch (inst.opf) {
4077c478bd9Sstevel@tonic-gate 	case edge8:
4087c478bd9Sstevel@tonic-gate 	case edge8n:
4097c478bd9Sstevel@tonic-gate 	case edge8l:
4107c478bd9Sstevel@tonic-gate 	case edge8ln:
4117c478bd9Sstevel@tonic-gate 		al3l = addrl & 0x7;
4127c478bd9Sstevel@tonic-gate 		switch (inst.opf) {
4137c478bd9Sstevel@tonic-gate 		case edge8:
4147c478bd9Sstevel@tonic-gate 		case edge8n:
4157c478bd9Sstevel@tonic-gate 			if (inst.opf == edge8) {
4167c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge8);
4177c478bd9Sstevel@tonic-gate 			} else {
4187c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge8n);
4197c478bd9Sstevel@tonic-gate 			}
4205892374fSdf 			mask = 0xff >> al3l;
4217c478bd9Sstevel@tonic-gate 			if (ah61l == ah61r) {
4227c478bd9Sstevel@tonic-gate 				al3r = addrr & 0x7;
4235892374fSdf 				mask &= (0xff << (0x7 - al3r)) & 0xff;
4247c478bd9Sstevel@tonic-gate 			}
4257c478bd9Sstevel@tonic-gate 			break;
4267c478bd9Sstevel@tonic-gate 		case edge8l:
4277c478bd9Sstevel@tonic-gate 		case edge8ln:
4287c478bd9Sstevel@tonic-gate 			if (inst.opf == edge8l) {
4297c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge8l);
4307c478bd9Sstevel@tonic-gate 			} else {
4317c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge8ln);
4327c478bd9Sstevel@tonic-gate 			}
4335892374fSdf 			mask = (0xff << al3l) & 0xff;
4347c478bd9Sstevel@tonic-gate 			if (ah61l == ah61r) {
4357c478bd9Sstevel@tonic-gate 				al3r = addrr & 0x7;
4365892374fSdf 				mask &= 0xff >> (0x7 - al3r);
4377c478bd9Sstevel@tonic-gate 			}
4387c478bd9Sstevel@tonic-gate 			break;
4397c478bd9Sstevel@tonic-gate 		}
4407c478bd9Sstevel@tonic-gate 		break;
4417c478bd9Sstevel@tonic-gate 	case edge16:
4427c478bd9Sstevel@tonic-gate 	case edge16l:
4437c478bd9Sstevel@tonic-gate 	case edge16n:
4447c478bd9Sstevel@tonic-gate 	case edge16ln:
4457c478bd9Sstevel@tonic-gate 		al3l = addrl & 0x6;
4465892374fSdf 		al3l >>= 0x1;
4477c478bd9Sstevel@tonic-gate 		switch (inst.opf) {
4487c478bd9Sstevel@tonic-gate 		case edge16:
4497c478bd9Sstevel@tonic-gate 		case edge16n:
4507c478bd9Sstevel@tonic-gate 			if (inst.opf == edge16) {
4517c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge16);
4527c478bd9Sstevel@tonic-gate 
4537c478bd9Sstevel@tonic-gate 			} else {
4547c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge16n);
4557c478bd9Sstevel@tonic-gate 			}
4565892374fSdf 			mask = 0xf >> al3l;
4577c478bd9Sstevel@tonic-gate 			if (ah61l == ah61r) {
4587c478bd9Sstevel@tonic-gate 				al3r = addrr & 0x6;
4595892374fSdf 				al3r >>= 0x1;
4605892374fSdf 				mask &= (0xf << (0x3 - al3r)) & 0xf;
4617c478bd9Sstevel@tonic-gate 			}
4627c478bd9Sstevel@tonic-gate 			break;
4637c478bd9Sstevel@tonic-gate 		case edge16l:
4647c478bd9Sstevel@tonic-gate 		case edge16ln:
4657c478bd9Sstevel@tonic-gate 			if (inst.opf == edge16l) {
4667c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge16l);
4677c478bd9Sstevel@tonic-gate 
4687c478bd9Sstevel@tonic-gate 			} else {
4697c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge16ln);
4707c478bd9Sstevel@tonic-gate 			}
4715892374fSdf 
4725892374fSdf 			mask = (0xf << al3l) & 0xf;
4737c478bd9Sstevel@tonic-gate 			if (ah61l == ah61r) {
4747c478bd9Sstevel@tonic-gate 				al3r = addrr & 0x6;
4755892374fSdf 				al3r >>= 0x1;
4765892374fSdf 				mask &= 0xf >> (0x3 - al3r);
4777c478bd9Sstevel@tonic-gate 			}
4787c478bd9Sstevel@tonic-gate 			break;
4797c478bd9Sstevel@tonic-gate 		}
4807c478bd9Sstevel@tonic-gate 		break;
4817c478bd9Sstevel@tonic-gate 	case edge32:
4827c478bd9Sstevel@tonic-gate 	case edge32l:
4837c478bd9Sstevel@tonic-gate 	case edge32n:
4847c478bd9Sstevel@tonic-gate 	case edge32ln:
4857c478bd9Sstevel@tonic-gate 		al3l = addrl & 0x4;
4865892374fSdf 		al3l >>= 0x2;
4875892374fSdf 
4887c478bd9Sstevel@tonic-gate 		switch (inst.opf) {
4897c478bd9Sstevel@tonic-gate 		case edge32:
4907c478bd9Sstevel@tonic-gate 		case edge32n:
4917c478bd9Sstevel@tonic-gate 			if (inst.opf == edge32) {
4927c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge32);
4937c478bd9Sstevel@tonic-gate 
4947c478bd9Sstevel@tonic-gate 			} else {
4957c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge32n);
4967c478bd9Sstevel@tonic-gate 			}
4975892374fSdf 			mask = 0x3 >> al3l;
4987c478bd9Sstevel@tonic-gate 			if (ah61l == ah61r) {
4997c478bd9Sstevel@tonic-gate 				al3r = addrr & 0x4;
5005892374fSdf 				al3r >>= 0x2;
5015892374fSdf 				mask &= (0x3 << (0x1 - al3r)) & 0x3;
5027c478bd9Sstevel@tonic-gate 			}
5037c478bd9Sstevel@tonic-gate 			break;
5047c478bd9Sstevel@tonic-gate 		case edge32l:
5057c478bd9Sstevel@tonic-gate 		case edge32ln:
5067c478bd9Sstevel@tonic-gate 			if (inst.opf == edge32l) {
5077c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge32l);
5087c478bd9Sstevel@tonic-gate 
5097c478bd9Sstevel@tonic-gate 			} else {
5107c478bd9Sstevel@tonic-gate 				VISINFO_KSTAT(vis_edge32ln);
5117c478bd9Sstevel@tonic-gate 			}
5125892374fSdf 			mask = (0x3 << al3l) & 0x3;
5137c478bd9Sstevel@tonic-gate 			if (ah61l == ah61r) {
5147c478bd9Sstevel@tonic-gate 				al3r = addrr & 0x4;
5155892374fSdf 				al3r >>= 0x2;
5165892374fSdf 				mask &= 0x3 >> (0x1 - al3r);
5177c478bd9Sstevel@tonic-gate 			}
5187c478bd9Sstevel@tonic-gate 			break;
5197c478bd9Sstevel@tonic-gate 		}
5207c478bd9Sstevel@tonic-gate 		break;
5217c478bd9Sstevel@tonic-gate 	}
5225892374fSdf 
5237c478bd9Sstevel@tonic-gate 	ftt = write_iureg(pfpsd, nrd, pregs, prw, &mask);
5247c478bd9Sstevel@tonic-gate 
5257c478bd9Sstevel@tonic-gate 	switch (inst.opf) {
5267c478bd9Sstevel@tonic-gate 	case edge8:
5277c478bd9Sstevel@tonic-gate 	case edge8l:
5287c478bd9Sstevel@tonic-gate 	case edge16:
5297c478bd9Sstevel@tonic-gate 	case edge16l:
5307c478bd9Sstevel@tonic-gate 	case edge32:
5317c478bd9Sstevel@tonic-gate 	case edge32l:
5327c478bd9Sstevel@tonic-gate 
533bfb7f382Skalai 		/* Update flags per SUBcc outcome */
534bfb7f382Skalai 		pregs->r_tstate &= ~((uint64_t)TSTATE_CCR_MASK
535bfb7f382Skalai 					<< TSTATE_CCR_SHIFT);
536bfb7f382Skalai 		ccr = get_subcc_ccr(addrl, addrr);  /* get subcc cond. codes */
537bfb7f382Skalai 		pregs->r_tstate |= ((uint64_t)ccr << TSTATE_CCR_SHIFT);
538bfb7f382Skalai 
5397c478bd9Sstevel@tonic-gate 		break;
5407c478bd9Sstevel@tonic-gate 	}
5417c478bd9Sstevel@tonic-gate 	return (ftt);
542bfb7f382Skalai }
543bfb7f382Skalai 
5447c478bd9Sstevel@tonic-gate /*
5457c478bd9Sstevel@tonic-gate  * Simulator for three dimentional array addressing instructions.
5467c478bd9Sstevel@tonic-gate  */
5477c478bd9Sstevel@tonic-gate static enum ftt_type
5487c478bd9Sstevel@tonic-gate vis_array(
5497c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
5507c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* FPU instruction to simulate. */
5517c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
5527c478bd9Sstevel@tonic-gate 	void		*prw)	/* Pointer to locals and ins. */
5537c478bd9Sstevel@tonic-gate 
5547c478bd9Sstevel@tonic-gate {
5557c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
5567c478bd9Sstevel@tonic-gate 	enum ftt_type ftt;
5577c478bd9Sstevel@tonic-gate 	uint64_t laddr, bsize, baddr;
5587c478bd9Sstevel@tonic-gate 	uint64_t nbit;
5597c478bd9Sstevel@tonic-gate 	int oy, oz;
5607c478bd9Sstevel@tonic-gate 
5617c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
5627c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
5637c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
5647c478bd9Sstevel@tonic-gate 
5657c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs1, pregs, prw, &laddr);
5667c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
5677c478bd9Sstevel@tonic-gate 		return (ftt);
5687c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs2, pregs, prw, &bsize);
5697c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
5707c478bd9Sstevel@tonic-gate 		return (ftt);
5717c478bd9Sstevel@tonic-gate 
5727c478bd9Sstevel@tonic-gate 	if (bsize > 5) {
5737c478bd9Sstevel@tonic-gate 		bsize = 5;
5747c478bd9Sstevel@tonic-gate 	}
5757c478bd9Sstevel@tonic-gate 	nbit = (1 << bsize) - 1;	/* Number of bits for XY<6+n-1:6> */
5767c478bd9Sstevel@tonic-gate 	oy = 17 + bsize;		/* Offset of Y<6+n-1:6> */
5777c478bd9Sstevel@tonic-gate 	oz = 17 + 2 * bsize;		/* Offset of Z<8:5> */
5787c478bd9Sstevel@tonic-gate 
5797c478bd9Sstevel@tonic-gate 	baddr = 0;
5807c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (11 -  0)) & (0x03 <<  0);	/* X_integer<1:0> */
5817c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (33 -  2)) & (0x03 <<  2);	/* Y_integer<1:0> */
5827c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (55 -  4)) & (0x01 <<  4);	/* Z_integer<0>   */
5837c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (13 -  5)) & (0x0f <<  5);	/* X_integer<5:2> */
5847c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (35 -  9)) & (0x0f <<  9);	/* Y_integer<5:2> */
5857c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (56 - 13)) & (0x0f << 13);	/* Z_integer<4:1> */
5867c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (17 - 17)) & (nbit << 17);	/* X_integer<6+n-1:6> */
5877c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (39 - oy)) & (nbit << oy);	/* Y_integer<6+n-1:6> */
5887c478bd9Sstevel@tonic-gate 	baddr |= (laddr >> (60 - oz)) & (0x0f << oz);	/* Z_integer<8:5> */
5897c478bd9Sstevel@tonic-gate 
5907c478bd9Sstevel@tonic-gate 	switch (inst.opf) {
5917c478bd9Sstevel@tonic-gate 	case array8:
5927c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_array8);
5937c478bd9Sstevel@tonic-gate 		break;
5947c478bd9Sstevel@tonic-gate 	case array16:
5957c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_array16);
5967c478bd9Sstevel@tonic-gate 		baddr <<= 1;
5977c478bd9Sstevel@tonic-gate 		break;
5987c478bd9Sstevel@tonic-gate 	case array32:
5997c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_array32);
6007c478bd9Sstevel@tonic-gate 		baddr <<= 2;
6017c478bd9Sstevel@tonic-gate 		break;
6027c478bd9Sstevel@tonic-gate 	}
6037c478bd9Sstevel@tonic-gate 
6047c478bd9Sstevel@tonic-gate 	ftt = write_iureg(pfpsd, nrd, pregs, prw, &baddr);
6057c478bd9Sstevel@tonic-gate 
6067c478bd9Sstevel@tonic-gate 	return (ftt);
6077c478bd9Sstevel@tonic-gate }
6087c478bd9Sstevel@tonic-gate 
6097c478bd9Sstevel@tonic-gate /*
6107c478bd9Sstevel@tonic-gate  * Simulator for alignaddr and alignaddrl instructions.
6117c478bd9Sstevel@tonic-gate  */
6127c478bd9Sstevel@tonic-gate static enum ftt_type
6137c478bd9Sstevel@tonic-gate vis_alignaddr(
6147c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
6157c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* FPU instruction to simulate. */
6167c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
6177c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
6187c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
6197c478bd9Sstevel@tonic-gate {
6207c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
6217c478bd9Sstevel@tonic-gate 	enum ftt_type ftt;
6227c478bd9Sstevel@tonic-gate 	uint64_t ea, tea, g, r;
6237c478bd9Sstevel@tonic-gate 	short s;
6247c478bd9Sstevel@tonic-gate 
6257c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
6267c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
6277c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
6287c478bd9Sstevel@tonic-gate 
6297c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs1, pregs, prw, &ea);
6307c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
6317c478bd9Sstevel@tonic-gate 		return (ftt);
6327c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs2, pregs, prw, &tea);
6337c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
6347c478bd9Sstevel@tonic-gate 		return (ftt);
6357c478bd9Sstevel@tonic-gate 	ea += tea;
6367c478bd9Sstevel@tonic-gate 	r = ea & ~0x7;	/* zero least 3 significant bits */
6377c478bd9Sstevel@tonic-gate 	ftt = write_iureg(pfpsd, nrd, pregs, prw, &r);
6387c478bd9Sstevel@tonic-gate 
6397c478bd9Sstevel@tonic-gate 
6405892374fSdf 	g = pfpsd->fp_current_read_gsr(fp);
6417c478bd9Sstevel@tonic-gate 	g &= ~(GSR_ALIGN_MASK);		/* zero the align offset */
6427c478bd9Sstevel@tonic-gate 	r = ea & 0x7;
6437c478bd9Sstevel@tonic-gate 	if (inst.opf == alignaddrl) {
6447c478bd9Sstevel@tonic-gate 		s = (short)(~r);	/* 2's complement for alignaddrl */
6457c478bd9Sstevel@tonic-gate 		if (s < 0)
6467c478bd9Sstevel@tonic-gate 			r = (uint64_t)((s + 1) & 0x7);
6477c478bd9Sstevel@tonic-gate 		else
6487c478bd9Sstevel@tonic-gate 			r = (uint64_t)(s & 0x7);
6497c478bd9Sstevel@tonic-gate 	}
6507c478bd9Sstevel@tonic-gate 	g |= (r << GSR_ALIGN_SHIFT) & GSR_ALIGN_MASK;
6515892374fSdf 	pfpsd->fp_current_write_gsr(g, fp);
6527c478bd9Sstevel@tonic-gate 
6537c478bd9Sstevel@tonic-gate 	return (ftt);
6547c478bd9Sstevel@tonic-gate }
6557c478bd9Sstevel@tonic-gate 
6567c478bd9Sstevel@tonic-gate /*
6577c478bd9Sstevel@tonic-gate  * Simulator for bmask instruction.
6587c478bd9Sstevel@tonic-gate  */
6597c478bd9Sstevel@tonic-gate static enum ftt_type
6607c478bd9Sstevel@tonic-gate vis_bmask(
6617c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
6627c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* FPU instruction to simulate. */
6637c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
6647c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
6657c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
6667c478bd9Sstevel@tonic-gate {
6677c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
6687c478bd9Sstevel@tonic-gate 	enum ftt_type ftt;
6697c478bd9Sstevel@tonic-gate 	uint64_t ea, tea, g;
6707c478bd9Sstevel@tonic-gate 
6717c478bd9Sstevel@tonic-gate 	VISINFO_KSTAT(vis_bmask);
6727c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
6737c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
6747c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
6757c478bd9Sstevel@tonic-gate 
6767c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs1, pregs, prw, &ea);
6777c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
6787c478bd9Sstevel@tonic-gate 		return (ftt);
6797c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs2, pregs, prw, &tea);
6807c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
6817c478bd9Sstevel@tonic-gate 		return (ftt);
6827c478bd9Sstevel@tonic-gate 	ea += tea;
6837c478bd9Sstevel@tonic-gate 	ftt = write_iureg(pfpsd, nrd, pregs, prw, &ea);
6847c478bd9Sstevel@tonic-gate 
6855892374fSdf 	g = pfpsd->fp_current_read_gsr(fp);
6867c478bd9Sstevel@tonic-gate 	g &= ~(GSR_MASK_MASK);		/* zero the mask offset */
6877c478bd9Sstevel@tonic-gate 
6887c478bd9Sstevel@tonic-gate 	/* Put the least significant 32 bits of ea in GSR.mask */
6897c478bd9Sstevel@tonic-gate 	g |= (ea << GSR_MASK_SHIFT) & GSR_MASK_MASK;
6905892374fSdf 	pfpsd->fp_current_write_gsr(g, fp);
6917c478bd9Sstevel@tonic-gate 	return (ftt);
6927c478bd9Sstevel@tonic-gate }
6937c478bd9Sstevel@tonic-gate 
6947c478bd9Sstevel@tonic-gate /*
6957c478bd9Sstevel@tonic-gate  * Simulator for fp[add|sub]* instruction.
6967c478bd9Sstevel@tonic-gate  */
6977c478bd9Sstevel@tonic-gate static enum ftt_type
6987c478bd9Sstevel@tonic-gate vis_fpaddsub(
6997c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
7007c478bd9Sstevel@tonic-gate 	vis_inst_type	inst)	/* FPU instruction to simulate. */
7017c478bd9Sstevel@tonic-gate {
7027c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
7037c478bd9Sstevel@tonic-gate 	union {
7047c478bd9Sstevel@tonic-gate 		uint64_t	ll;
7057c478bd9Sstevel@tonic-gate 		uint32_t	i[2];
7067c478bd9Sstevel@tonic-gate 		uint16_t	s[4];
7077c478bd9Sstevel@tonic-gate 	} lrs1, lrs2, lrd;
7087c478bd9Sstevel@tonic-gate 	union {
7097c478bd9Sstevel@tonic-gate 		uint32_t	i;
7107c478bd9Sstevel@tonic-gate 		uint16_t	s[2];
7117c478bd9Sstevel@tonic-gate 	} krs1, krs2, krd;
7127c478bd9Sstevel@tonic-gate 	int i;
7137c478bd9Sstevel@tonic-gate 
7147c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
7157c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
7167c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
7177c478bd9Sstevel@tonic-gate 	if ((inst.opf & 1) == 0) {	/* double precision */
7187c478bd9Sstevel@tonic-gate 		if ((nrs1 & 1) == 1) 	/* fix register encoding */
7197c478bd9Sstevel@tonic-gate 			nrs1 = (nrs1 & 0x1e) | 0x20;
7207c478bd9Sstevel@tonic-gate 		if ((nrs2 & 1) == 1)
7217c478bd9Sstevel@tonic-gate 			nrs2 = (nrs2 & 0x1e) | 0x20;
7227c478bd9Sstevel@tonic-gate 		if ((nrd & 1) == 1)
7237c478bd9Sstevel@tonic-gate 			nrd = (nrd & 0x1e) | 0x20;
7247c478bd9Sstevel@tonic-gate 	}
7257c478bd9Sstevel@tonic-gate 	switch (inst.opf) {
7267c478bd9Sstevel@tonic-gate 	case fpadd16:
7277c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
7287c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
7297c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
7307c478bd9Sstevel@tonic-gate 			lrd.s[i] = lrs1.s[i] + lrs2.s[i];
7317c478bd9Sstevel@tonic-gate 		}
7327c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
7337c478bd9Sstevel@tonic-gate 		break;
7347c478bd9Sstevel@tonic-gate 	case fpadd16s:
7357c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
7367c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
7377c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
7387c478bd9Sstevel@tonic-gate 			krd.s[i] = krs1.s[i] + krs2.s[i];
7397c478bd9Sstevel@tonic-gate 		}
7407c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &krd.i, nrd);
7417c478bd9Sstevel@tonic-gate 		break;
7427c478bd9Sstevel@tonic-gate 	case fpadd32:
7437c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
7447c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
7457c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
7467c478bd9Sstevel@tonic-gate 			lrd.i[i] = lrs1.i[i] + lrs2.i[i];
7477c478bd9Sstevel@tonic-gate 		}
7487c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
7497c478bd9Sstevel@tonic-gate 		break;
7507c478bd9Sstevel@tonic-gate 	case fpadd32s:
7517c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
7527c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
7537c478bd9Sstevel@tonic-gate 		krd.i = krs1.i + krs2.i;
7547c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &krd.i, nrd);
7557c478bd9Sstevel@tonic-gate 		break;
7567c478bd9Sstevel@tonic-gate 	case fpsub16:
7577c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
7587c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
7597c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
7607c478bd9Sstevel@tonic-gate 			lrd.s[i] = lrs1.s[i] - lrs2.s[i];
7617c478bd9Sstevel@tonic-gate 		}
7627c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
7637c478bd9Sstevel@tonic-gate 		break;
7647c478bd9Sstevel@tonic-gate 	case fpsub16s:
7657c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
7667c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
7677c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
7687c478bd9Sstevel@tonic-gate 			krd.s[i] = krs1.s[i] - krs2.s[i];
7697c478bd9Sstevel@tonic-gate 		}
7707c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &krd.i, nrd);
7717c478bd9Sstevel@tonic-gate 		break;
7727c478bd9Sstevel@tonic-gate 	case fpsub32:
7737c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
7747c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
7757c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
7767c478bd9Sstevel@tonic-gate 			lrd.i[i] = lrs1.i[i] - lrs2.i[i];
7777c478bd9Sstevel@tonic-gate 		}
7787c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
7797c478bd9Sstevel@tonic-gate 		break;
7807c478bd9Sstevel@tonic-gate 	case fpsub32s:
7817c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
7827c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
7837c478bd9Sstevel@tonic-gate 		krd.i = krs1.i - krs2.i;
7847c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &krd.i, nrd);
7857c478bd9Sstevel@tonic-gate 		break;
7867c478bd9Sstevel@tonic-gate 	}
7877c478bd9Sstevel@tonic-gate 	return (ftt_none);
7887c478bd9Sstevel@tonic-gate }
7897c478bd9Sstevel@tonic-gate 
7907c478bd9Sstevel@tonic-gate /*
7917c478bd9Sstevel@tonic-gate  * Simulator for fcmp* instruction.
7927c478bd9Sstevel@tonic-gate  */
7937c478bd9Sstevel@tonic-gate static enum ftt_type
7947c478bd9Sstevel@tonic-gate vis_fcmp(
7957c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
7967c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* FPU instruction to simulate. */
7977c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
7987c478bd9Sstevel@tonic-gate 	void		*prw)	/* Pointer to locals and ins. */
7997c478bd9Sstevel@tonic-gate {
8007c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
8017c478bd9Sstevel@tonic-gate 	union {
8027c478bd9Sstevel@tonic-gate 		uint64_t	ll;
8037c478bd9Sstevel@tonic-gate 		uint32_t	i[2];
8047c478bd9Sstevel@tonic-gate 		uint16_t	s[4];
8057c478bd9Sstevel@tonic-gate 	} krs1, krs2, krd;
8067c478bd9Sstevel@tonic-gate 	enum ftt_type ftt;
8077c478bd9Sstevel@tonic-gate 	short sr1, sr2;
8087c478bd9Sstevel@tonic-gate 	int i, ir1, ir2;
8097c478bd9Sstevel@tonic-gate 
8107c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
8117c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
8127c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
8137c478bd9Sstevel@tonic-gate 	krd.ll = 0;
8147c478bd9Sstevel@tonic-gate 	if ((nrs1 & 1) == 1) 	/* fix register encoding */
8157c478bd9Sstevel@tonic-gate 		nrs1 = (nrs1 & 0x1e) | 0x20;
8167c478bd9Sstevel@tonic-gate 	if ((nrs2 & 1) == 1)
8177c478bd9Sstevel@tonic-gate 		nrs2 = (nrs2 & 0x1e) | 0x20;
8187c478bd9Sstevel@tonic-gate 
8197c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &krs1.ll, nrs1);
8207c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &krs2.ll, nrs2);
8217c478bd9Sstevel@tonic-gate 	switch (inst.opf) {
8227c478bd9Sstevel@tonic-gate 	case fcmple16:
8237c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fcmple16);
8247c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
8257c478bd9Sstevel@tonic-gate 			sr1 = (short)krs1.s[i];
8267c478bd9Sstevel@tonic-gate 			sr2 = (short)krs2.s[i];
8277c478bd9Sstevel@tonic-gate 			if (sr1 <= sr2)
8287c478bd9Sstevel@tonic-gate 				krd.ll += (0x8 >> i);
8297c478bd9Sstevel@tonic-gate 		}
8307c478bd9Sstevel@tonic-gate 		break;
8317c478bd9Sstevel@tonic-gate 	case fcmpne16:
8327c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fcmpne16);
8337c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
8347c478bd9Sstevel@tonic-gate 			sr1 = (short)krs1.s[i];
8357c478bd9Sstevel@tonic-gate 			sr2 = (short)krs2.s[i];
8367c478bd9Sstevel@tonic-gate 			if (sr1 != sr2)
8377c478bd9Sstevel@tonic-gate 				krd.ll += (0x8 >> i);
8387c478bd9Sstevel@tonic-gate 		}
8397c478bd9Sstevel@tonic-gate 		break;
8407c478bd9Sstevel@tonic-gate 	case fcmpgt16:
8417c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fcmpgt16);
8427c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
8437c478bd9Sstevel@tonic-gate 			sr1 = (short)krs1.s[i];
8447c478bd9Sstevel@tonic-gate 			sr2 = (short)krs2.s[i];
8457c478bd9Sstevel@tonic-gate 			if (sr1 > sr2)
8467c478bd9Sstevel@tonic-gate 				krd.ll += (0x8 >> i);
8477c478bd9Sstevel@tonic-gate 		}
8487c478bd9Sstevel@tonic-gate 		break;
8497c478bd9Sstevel@tonic-gate 	case fcmpeq16:
8507c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fcmpeq16);
8517c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
8527c478bd9Sstevel@tonic-gate 			sr1 = (short)krs1.s[i];
8537c478bd9Sstevel@tonic-gate 			sr2 = (short)krs2.s[i];
8547c478bd9Sstevel@tonic-gate 			if (sr1 == sr2)
8557c478bd9Sstevel@tonic-gate 				krd.ll += (0x8 >> i);
8567c478bd9Sstevel@tonic-gate 		}
8577c478bd9Sstevel@tonic-gate 		break;
8587c478bd9Sstevel@tonic-gate 	case fcmple32:
8597c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fcmple32);
8607c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
8617c478bd9Sstevel@tonic-gate 			ir1 = (int)krs1.i[i];
8627c478bd9Sstevel@tonic-gate 			ir2 = (int)krs2.i[i];
8637c478bd9Sstevel@tonic-gate 			if (ir1 <= ir2)
8647c478bd9Sstevel@tonic-gate 				krd.ll += (0x2 >> i);
8657c478bd9Sstevel@tonic-gate 		}
8667c478bd9Sstevel@tonic-gate 		break;
8677c478bd9Sstevel@tonic-gate 	case fcmpne32:
8687c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fcmpne32);
8697c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
8707c478bd9Sstevel@tonic-gate 			ir1 = (int)krs1.i[i];
8717c478bd9Sstevel@tonic-gate 			ir2 = (int)krs2.i[i];
8727c478bd9Sstevel@tonic-gate 			if (ir1 != ir2)
8737c478bd9Sstevel@tonic-gate 				krd.ll += (0x2 >> i);
8747c478bd9Sstevel@tonic-gate 		}
8757c478bd9Sstevel@tonic-gate 		break;
8767c478bd9Sstevel@tonic-gate 	case fcmpgt32:
8777c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fcmpgt32);
8787c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
8797c478bd9Sstevel@tonic-gate 			ir1 = (int)krs1.i[i];
8807c478bd9Sstevel@tonic-gate 			ir2 = (int)krs2.i[i];
8817c478bd9Sstevel@tonic-gate 			if (ir1 > ir2)
8827c478bd9Sstevel@tonic-gate 				krd.ll += (0x2 >> i);
8837c478bd9Sstevel@tonic-gate 		}
8847c478bd9Sstevel@tonic-gate 		break;
8857c478bd9Sstevel@tonic-gate 	case fcmpeq32:
8867c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fcmpeq32);
8877c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
8887c478bd9Sstevel@tonic-gate 			ir1 = (int)krs1.i[i];
8897c478bd9Sstevel@tonic-gate 			ir2 = (int)krs2.i[i];
8907c478bd9Sstevel@tonic-gate 			if (ir1 == ir2)
8917c478bd9Sstevel@tonic-gate 				krd.ll += (0x2 >> i);
8927c478bd9Sstevel@tonic-gate 		}
8937c478bd9Sstevel@tonic-gate 		break;
8947c478bd9Sstevel@tonic-gate 	}
8957c478bd9Sstevel@tonic-gate 	ftt = write_iureg(pfpsd, nrd, pregs, prw, &krd.ll);
8967c478bd9Sstevel@tonic-gate 	return (ftt);
8977c478bd9Sstevel@tonic-gate }
8987c478bd9Sstevel@tonic-gate 
8997c478bd9Sstevel@tonic-gate /*
9007c478bd9Sstevel@tonic-gate  * Simulator for fmul* instruction.
9017c478bd9Sstevel@tonic-gate  */
9027c478bd9Sstevel@tonic-gate static enum ftt_type
9037c478bd9Sstevel@tonic-gate vis_fmul(
9047c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
9057c478bd9Sstevel@tonic-gate 	vis_inst_type	inst)	/* FPU instruction to simulate. */
9067c478bd9Sstevel@tonic-gate {
9077c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
9087c478bd9Sstevel@tonic-gate 	union {
9097c478bd9Sstevel@tonic-gate 		uint64_t	ll;
9107c478bd9Sstevel@tonic-gate 		uint32_t	i[2];
9117c478bd9Sstevel@tonic-gate 		uint16_t	s[4];
9127c478bd9Sstevel@tonic-gate 		uint8_t		c[8];
9137c478bd9Sstevel@tonic-gate 	} lrs1, lrs2, lrd;
9147c478bd9Sstevel@tonic-gate 	union {
9157c478bd9Sstevel@tonic-gate 		uint32_t	i;
9167c478bd9Sstevel@tonic-gate 		uint16_t	s[2];
9177c478bd9Sstevel@tonic-gate 		uint8_t		c[4];
9187c478bd9Sstevel@tonic-gate 	} krs1, krs2, kres;
9197c478bd9Sstevel@tonic-gate 	short s1, s2, sres;
9207c478bd9Sstevel@tonic-gate 	ushort_t us1;
9217c478bd9Sstevel@tonic-gate 	char c1;
9227c478bd9Sstevel@tonic-gate 	int i;
9237c478bd9Sstevel@tonic-gate 
9247c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
9257c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
9267c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
9277c478bd9Sstevel@tonic-gate 	if ((inst.opf & 1) == 0) {	/* double precision */
9287c478bd9Sstevel@tonic-gate 		if ((nrd & 1) == 1) 	/* fix register encoding */
9297c478bd9Sstevel@tonic-gate 			nrd = (nrd & 0x1e) | 0x20;
9307c478bd9Sstevel@tonic-gate 	}
9317c478bd9Sstevel@tonic-gate 
9327c478bd9Sstevel@tonic-gate 	switch (inst.opf) {
9337c478bd9Sstevel@tonic-gate 	case fmul8x16:
9347c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fmul8x16);
9357c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
9367c478bd9Sstevel@tonic-gate 		if ((nrs2 & 1) == 1)
9377c478bd9Sstevel@tonic-gate 			nrs2 = (nrs2 & 0x1e) | 0x20;
9387c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
9397c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
9407c478bd9Sstevel@tonic-gate 			us1 = (ushort_t)krs1.c[i];
9417c478bd9Sstevel@tonic-gate 			s2 = (short)lrs2.s[i];
9427c478bd9Sstevel@tonic-gate 			kres.i = us1 * s2;
9437c478bd9Sstevel@tonic-gate 			sres = (short)((kres.c[1] << 8) | kres.c[2]);
9447c478bd9Sstevel@tonic-gate 			if (kres.c[3] >= 0x80)
9457c478bd9Sstevel@tonic-gate 				sres++;
9467c478bd9Sstevel@tonic-gate 			lrd.s[i] = sres;
9477c478bd9Sstevel@tonic-gate 		}
9487c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
9497c478bd9Sstevel@tonic-gate 		break;
9507c478bd9Sstevel@tonic-gate 	case fmul8x16au:
9517c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fmul8x16au);
9527c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
9537c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
9547c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
9557c478bd9Sstevel@tonic-gate 			us1 = (ushort_t)krs1.c[i];
9567c478bd9Sstevel@tonic-gate 			s2 = (short)krs2.s[0];
9577c478bd9Sstevel@tonic-gate 			kres.i = us1 * s2;
9587c478bd9Sstevel@tonic-gate 			sres = (short)((kres.c[1] << 8) | kres.c[2]);
9597c478bd9Sstevel@tonic-gate 			if (kres.c[3] >= 0x80)
9607c478bd9Sstevel@tonic-gate 				sres++;
9617c478bd9Sstevel@tonic-gate 			lrd.s[i] = sres;
9627c478bd9Sstevel@tonic-gate 		}
9637c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
9647c478bd9Sstevel@tonic-gate 		break;
9657c478bd9Sstevel@tonic-gate 	case fmul8x16al:
9667c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fmul8x16al);
9677c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
9687c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
9697c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
9707c478bd9Sstevel@tonic-gate 			us1 = (ushort_t)krs1.c[i];
9717c478bd9Sstevel@tonic-gate 			s2 = (short)krs2.s[1];
9727c478bd9Sstevel@tonic-gate 			kres.i = us1 * s2;
9737c478bd9Sstevel@tonic-gate 			sres = (short)((kres.c[1] << 8) | kres.c[2]);
9747c478bd9Sstevel@tonic-gate 			if (kres.c[3] >= 0x80)
9757c478bd9Sstevel@tonic-gate 				sres++;
9767c478bd9Sstevel@tonic-gate 			lrd.s[i] = sres;
9777c478bd9Sstevel@tonic-gate 		}
9787c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
9797c478bd9Sstevel@tonic-gate 		break;
9807c478bd9Sstevel@tonic-gate 	case fmul8sux16:
9817c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fmul8sux16);
9827c478bd9Sstevel@tonic-gate 		if ((nrs1 & 1) == 1) 	/* fix register encoding */
9837c478bd9Sstevel@tonic-gate 			nrs1 = (nrs1 & 0x1e) | 0x20;
9847c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
9857c478bd9Sstevel@tonic-gate 		if ((nrs2 & 1) == 1)
9867c478bd9Sstevel@tonic-gate 			nrs2 = (nrs2 & 0x1e) | 0x20;
9877c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
9887c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
9897c478bd9Sstevel@tonic-gate 			c1 = lrs1.c[(i*2)];
9907c478bd9Sstevel@tonic-gate 			s1 = (short)c1;		/* keeps the sign alive */
9917c478bd9Sstevel@tonic-gate 			s2 = (short)lrs2.s[i];
9927c478bd9Sstevel@tonic-gate 			kres.i = s1 * s2;
9937c478bd9Sstevel@tonic-gate 			sres = (short)((kres.c[1] << 8) | kres.c[2]);
9947c478bd9Sstevel@tonic-gate 			if (kres.c[3] >= 0x80)
9957c478bd9Sstevel@tonic-gate 				sres++;
9967c478bd9Sstevel@tonic-gate 			if (sres < 0)
9977c478bd9Sstevel@tonic-gate 				lrd.s[i] = (sres & 0xFFFF);
9987c478bd9Sstevel@tonic-gate 			else
9997c478bd9Sstevel@tonic-gate 				lrd.s[i] = sres;
10007c478bd9Sstevel@tonic-gate 		}
10017c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
10027c478bd9Sstevel@tonic-gate 		break;
10037c478bd9Sstevel@tonic-gate 	case fmul8ulx16:
10047c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fmul8ulx16);
10057c478bd9Sstevel@tonic-gate 		if ((nrs1 & 1) == 1) 	/* fix register encoding */
10067c478bd9Sstevel@tonic-gate 			nrs1 = (nrs1 & 0x1e) | 0x20;
10077c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
10087c478bd9Sstevel@tonic-gate 		if ((nrs2 & 1) == 1)
10097c478bd9Sstevel@tonic-gate 			nrs2 = (nrs2 & 0x1e) | 0x20;
10107c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
10117c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
10127c478bd9Sstevel@tonic-gate 			us1 = (ushort_t)lrs1.c[(i*2)+1];
10137c478bd9Sstevel@tonic-gate 			s2 = (short)lrs2.s[i];
10147c478bd9Sstevel@tonic-gate 			kres.i = us1 * s2;
10157c478bd9Sstevel@tonic-gate 			sres = (short)kres.s[0];
10167c478bd9Sstevel@tonic-gate 			if (kres.s[1] >= 0x8000)
10177c478bd9Sstevel@tonic-gate 				sres++;
10187c478bd9Sstevel@tonic-gate 			lrd.s[i] = sres;
10197c478bd9Sstevel@tonic-gate 		}
10207c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
10217c478bd9Sstevel@tonic-gate 		break;
10227c478bd9Sstevel@tonic-gate 	case fmuld8sux16:
10237c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fmuld8sux16);
10247c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
10257c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
10267c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
10277c478bd9Sstevel@tonic-gate 			c1 = krs1.c[(i*2)];
10287c478bd9Sstevel@tonic-gate 			s1 = (short)c1;		/* keeps the sign alive */
10297c478bd9Sstevel@tonic-gate 			s2 = (short)krs2.s[i];
10307c478bd9Sstevel@tonic-gate 			kres.i = s1 * s2;
10317c478bd9Sstevel@tonic-gate 			lrd.i[i] = kres.i << 8;
10327c478bd9Sstevel@tonic-gate 		}
10337c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
10347c478bd9Sstevel@tonic-gate 		break;
10357c478bd9Sstevel@tonic-gate 	case fmuld8ulx16:
10367c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fmuld8ulx16);
10377c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
10387c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
10397c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
10407c478bd9Sstevel@tonic-gate 			us1 = (ushort_t)krs1.c[(i*2)+1];
10417c478bd9Sstevel@tonic-gate 			s2 = (short)krs2.s[i];
10427c478bd9Sstevel@tonic-gate 			lrd.i[i] = us1 * s2;
10437c478bd9Sstevel@tonic-gate 		}
10447c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
10457c478bd9Sstevel@tonic-gate 		break;
10467c478bd9Sstevel@tonic-gate 	}
10477c478bd9Sstevel@tonic-gate 	return (ftt_none);
10487c478bd9Sstevel@tonic-gate }
10497c478bd9Sstevel@tonic-gate 
10507c478bd9Sstevel@tonic-gate /*
10517c478bd9Sstevel@tonic-gate  * Simulator for fpixel formatting instructions.
10527c478bd9Sstevel@tonic-gate  */
10537c478bd9Sstevel@tonic-gate static enum ftt_type
10547c478bd9Sstevel@tonic-gate vis_fpixel(
10557c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
10567c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* FPU instruction to simulate. */
10577c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
10587c478bd9Sstevel@tonic-gate {
10597c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
10607c478bd9Sstevel@tonic-gate 	int	i, j, k, sf;
10617c478bd9Sstevel@tonic-gate 	union {
10627c478bd9Sstevel@tonic-gate 		uint64_t	ll;
10637c478bd9Sstevel@tonic-gate 		uint32_t	i[2];
10647c478bd9Sstevel@tonic-gate 		uint16_t	s[4];
10657c478bd9Sstevel@tonic-gate 		uint8_t		c[8];
10667c478bd9Sstevel@tonic-gate 	} lrs1, lrs2, lrd;
10677c478bd9Sstevel@tonic-gate 	union {
10687c478bd9Sstevel@tonic-gate 		uint32_t	i;
10697c478bd9Sstevel@tonic-gate 		uint16_t	s[2];
10707c478bd9Sstevel@tonic-gate 		uint8_t		c[4];
10717c478bd9Sstevel@tonic-gate 	} krs1, krs2, krd;
10727c478bd9Sstevel@tonic-gate 	uint64_t r;
10737c478bd9Sstevel@tonic-gate 	int64_t l, m;
10747c478bd9Sstevel@tonic-gate 	short s;
10757c478bd9Sstevel@tonic-gate 	uchar_t uc;
10767c478bd9Sstevel@tonic-gate 
10777c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
10787c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
10797c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
10807c478bd9Sstevel@tonic-gate 	if ((inst.opf != fpack16) && (inst.opf != fpackfix)) {
10817c478bd9Sstevel@tonic-gate 		if ((nrd & 1) == 1) 	/* fix register encoding */
10827c478bd9Sstevel@tonic-gate 			nrd = (nrd & 0x1e) | 0x20;
10837c478bd9Sstevel@tonic-gate 	}
10847c478bd9Sstevel@tonic-gate 
10857c478bd9Sstevel@tonic-gate 	switch (inst.opf) {
10867c478bd9Sstevel@tonic-gate 	case fpack16:
10877c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fpack16);
10887c478bd9Sstevel@tonic-gate 		if ((nrs2 & 1) == 1) 	/* fix register encoding */
10897c478bd9Sstevel@tonic-gate 			nrs2 = (nrs2 & 0x1e) | 0x20;
10907c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
10915892374fSdf 		r = pfpsd->fp_current_read_gsr(fp);
10927c478bd9Sstevel@tonic-gate 		/* fpack16 ignores GSR.scale msb */
10937c478bd9Sstevel@tonic-gate 		sf = (int)(GSR_SCALE(r) & 0xf);
10947c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
10957c478bd9Sstevel@tonic-gate 			s = (short)lrs2.s[i];	/* preserve the sign */
10967c478bd9Sstevel@tonic-gate 			j = ((int)s << sf);
10977c478bd9Sstevel@tonic-gate 			k = j >> 7;
10987c478bd9Sstevel@tonic-gate 			if (k < 0) {
10997c478bd9Sstevel@tonic-gate 				uc = 0;
11007c478bd9Sstevel@tonic-gate 			} else if (k > 255) {
11017c478bd9Sstevel@tonic-gate 				uc = 255;
11027c478bd9Sstevel@tonic-gate 			} else {
11037c478bd9Sstevel@tonic-gate 				uc = (uchar_t)k;
11047c478bd9Sstevel@tonic-gate 			}
11057c478bd9Sstevel@tonic-gate 			krd.c[i] = uc;
11067c478bd9Sstevel@tonic-gate 		}
11077c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &krd.i, nrd);
11087c478bd9Sstevel@tonic-gate 		break;
11097c478bd9Sstevel@tonic-gate 	case fpack32:
11107c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fpack32);
11117c478bd9Sstevel@tonic-gate 		if ((nrs1 & 1) == 1) 	/* fix register encoding */
11127c478bd9Sstevel@tonic-gate 			nrs1 = (nrs1 & 0x1e) | 0x20;
11137c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
11147c478bd9Sstevel@tonic-gate 		if ((nrs2 & 1) == 1)
11157c478bd9Sstevel@tonic-gate 			nrs2 = (nrs2 & 0x1e) | 0x20;
11167c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
11177c478bd9Sstevel@tonic-gate 
11185892374fSdf 		r = pfpsd->fp_current_read_gsr(fp);
11197c478bd9Sstevel@tonic-gate 		sf = (int)GSR_SCALE(r);
11207c478bd9Sstevel@tonic-gate 		lrd.ll = lrs1.ll << 8;
11217c478bd9Sstevel@tonic-gate 		for (i = 0, k = 3; i <= 1; i++, k += 4) {
11227c478bd9Sstevel@tonic-gate 			j = (int)lrs2.i[i];	/* preserve the sign */
11237c478bd9Sstevel@tonic-gate 			l = ((int64_t)j << sf);
11247c478bd9Sstevel@tonic-gate 			m = l >> 23;
11257c478bd9Sstevel@tonic-gate 			if (m < 0) {
11267c478bd9Sstevel@tonic-gate 				uc = 0;
11277c478bd9Sstevel@tonic-gate 			} else if (m > 255) {
11287c478bd9Sstevel@tonic-gate 				uc = 255;
11297c478bd9Sstevel@tonic-gate 			} else {
11307c478bd9Sstevel@tonic-gate 				uc = (uchar_t)m;
11317c478bd9Sstevel@tonic-gate 			}
11327c478bd9Sstevel@tonic-gate 			lrd.c[k] = uc;
11337c478bd9Sstevel@tonic-gate 		}
11347c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
11357c478bd9Sstevel@tonic-gate 		break;
11367c478bd9Sstevel@tonic-gate 	case fpackfix:
11377c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fpackfix);
11387c478bd9Sstevel@tonic-gate 		if ((nrs2 & 1) == 1)
11397c478bd9Sstevel@tonic-gate 			nrs2 = (nrs2 & 0x1e) | 0x20;
11407c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
11417c478bd9Sstevel@tonic-gate 
11425892374fSdf 		r = pfpsd->fp_current_read_gsr(fp);
11437c478bd9Sstevel@tonic-gate 		sf = (int)GSR_SCALE(r);
11447c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 1; i++) {
11457c478bd9Sstevel@tonic-gate 			j = (int)lrs2.i[i];	/* preserve the sign */
11467c478bd9Sstevel@tonic-gate 			l = ((int64_t)j << sf);
11477c478bd9Sstevel@tonic-gate 			m = l >> 16;
11487c478bd9Sstevel@tonic-gate 			if (m < -32768) {
11497c478bd9Sstevel@tonic-gate 				s = -32768;
11507c478bd9Sstevel@tonic-gate 			} else if (m > 32767) {
11517c478bd9Sstevel@tonic-gate 				s = 32767;
11527c478bd9Sstevel@tonic-gate 			} else {
11537c478bd9Sstevel@tonic-gate 				s = (short)m;
11547c478bd9Sstevel@tonic-gate 			}
11557c478bd9Sstevel@tonic-gate 			krd.s[i] = s;
11567c478bd9Sstevel@tonic-gate 		}
11577c478bd9Sstevel@tonic-gate 		_fp_pack_word(pfpsd, &krd.i, nrd);
11587c478bd9Sstevel@tonic-gate 		break;
11597c478bd9Sstevel@tonic-gate 	case fexpand:
11607c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fexpand);
11617c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
11627c478bd9Sstevel@tonic-gate 		for (i = 0; i <= 3; i++) {
11637c478bd9Sstevel@tonic-gate 			uc = krs2.c[i];
11647c478bd9Sstevel@tonic-gate 			lrd.s[i] = (ushort_t)(uc << 4);
11657c478bd9Sstevel@tonic-gate 		}
11667c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
11677c478bd9Sstevel@tonic-gate 		break;
11687c478bd9Sstevel@tonic-gate 	case fpmerge:
11697c478bd9Sstevel@tonic-gate 		VISINFO_KSTAT(vis_fpmerge);
11707c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs1.i, nrs1);
11717c478bd9Sstevel@tonic-gate 		_fp_unpack_word(pfpsd, &krs2.i, nrs2);
11727c478bd9Sstevel@tonic-gate 		for (i = 0, j = 0; i <= 3; i++, j += 2) {
11737c478bd9Sstevel@tonic-gate 			lrd.c[j] = krs1.c[i];
11747c478bd9Sstevel@tonic-gate 			lrd.c[j+1] = krs2.c[i];
11757c478bd9Sstevel@tonic-gate 		}
11767c478bd9Sstevel@tonic-gate 		_fp_pack_extword(pfpsd, &lrd.ll, nrd);
11777c478bd9Sstevel@tonic-gate 		break;
11787c478bd9Sstevel@tonic-gate 	}
11797c478bd9Sstevel@tonic-gate 	return (ftt_none);
11807c478bd9Sstevel@tonic-gate }
11817c478bd9Sstevel@tonic-gate 
11827c478bd9Sstevel@tonic-gate /*
11837c478bd9Sstevel@tonic-gate  * Simulator for pdist instruction.
11847c478bd9Sstevel@tonic-gate  */
11857c478bd9Sstevel@tonic-gate enum ftt_type
11867c478bd9Sstevel@tonic-gate vis_pdist(
11877c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
11887c478bd9Sstevel@tonic-gate 	fp_inst_type	pinst)	/* FPU instruction to simulate. */
11897c478bd9Sstevel@tonic-gate {
11907c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
11917c478bd9Sstevel@tonic-gate 	int	i;
11927c478bd9Sstevel@tonic-gate 	short	s;
11937c478bd9Sstevel@tonic-gate 	union {
11947c478bd9Sstevel@tonic-gate 		uint64_t	ll;
11957c478bd9Sstevel@tonic-gate 		uint8_t		c[8];
11967c478bd9Sstevel@tonic-gate 	} lrs1, lrs2, lrd;
11977c478bd9Sstevel@tonic-gate 
11987c478bd9Sstevel@tonic-gate 	nrs1 = pinst.rs1;
11997c478bd9Sstevel@tonic-gate 	nrs2 = pinst.rs2;
12007c478bd9Sstevel@tonic-gate 	nrd = pinst.rd;
12017c478bd9Sstevel@tonic-gate 	VISINFO_KSTAT(vis_pdist);
12027c478bd9Sstevel@tonic-gate 	if ((nrs1 & 1) == 1) 		/* fix register encoding */
12037c478bd9Sstevel@tonic-gate 		nrs1 = (nrs1 & 0x1e) | 0x20;
12047c478bd9Sstevel@tonic-gate 	if ((nrs2 & 1) == 1)
12057c478bd9Sstevel@tonic-gate 		nrs2 = (nrs2 & 0x1e) | 0x20;
12067c478bd9Sstevel@tonic-gate 	if ((nrd & 1) == 1)
12077c478bd9Sstevel@tonic-gate 		nrd = (nrd & 0x1e) | 0x20;
12087c478bd9Sstevel@tonic-gate 
12097c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
12107c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
12117c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &lrd.ll, nrd);
12127c478bd9Sstevel@tonic-gate 
12137c478bd9Sstevel@tonic-gate 	for (i = 0; i <= 7; i++) {
12147c478bd9Sstevel@tonic-gate 		s = (short)(lrs1.c[i] - lrs2.c[i]);
12157c478bd9Sstevel@tonic-gate 		if (s < 0)
12167c478bd9Sstevel@tonic-gate 			s = ~s + 1;
12177c478bd9Sstevel@tonic-gate 		lrd.ll += s;
12187c478bd9Sstevel@tonic-gate 	}
12197c478bd9Sstevel@tonic-gate 
12207c478bd9Sstevel@tonic-gate 	_fp_pack_extword(pfpsd, &lrd.ll, nrd);
12217c478bd9Sstevel@tonic-gate 	return (ftt_none);
12227c478bd9Sstevel@tonic-gate }
12237c478bd9Sstevel@tonic-gate 
12247c478bd9Sstevel@tonic-gate /*
12257c478bd9Sstevel@tonic-gate  * Simulator for faligndata instruction.
12267c478bd9Sstevel@tonic-gate  */
12277c478bd9Sstevel@tonic-gate static enum ftt_type
12287c478bd9Sstevel@tonic-gate vis_faligndata(
12297c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
12307c478bd9Sstevel@tonic-gate 	fp_inst_type	pinst,	/* FPU instruction to simulate. */
12317c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
12327c478bd9Sstevel@tonic-gate {
12337c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
12347c478bd9Sstevel@tonic-gate 	int	i, j, k, ao;
12357c478bd9Sstevel@tonic-gate 	union {
12367c478bd9Sstevel@tonic-gate 		uint64_t	ll;
12377c478bd9Sstevel@tonic-gate 		uint8_t		c[8];
12387c478bd9Sstevel@tonic-gate 	} lrs1, lrs2, lrd;
12397c478bd9Sstevel@tonic-gate 	uint64_t r;
12407c478bd9Sstevel@tonic-gate 
12417c478bd9Sstevel@tonic-gate 	nrs1 = pinst.rs1;
12427c478bd9Sstevel@tonic-gate 	nrs2 = pinst.rs2;
12437c478bd9Sstevel@tonic-gate 	nrd = pinst.rd;
12447c478bd9Sstevel@tonic-gate 	if ((nrs1 & 1) == 1) 		/* fix register encoding */
12457c478bd9Sstevel@tonic-gate 		nrs1 = (nrs1 & 0x1e) | 0x20;
12467c478bd9Sstevel@tonic-gate 	if ((nrs2 & 1) == 1)
12477c478bd9Sstevel@tonic-gate 		nrs2 = (nrs2 & 0x1e) | 0x20;
12487c478bd9Sstevel@tonic-gate 	if ((nrd & 1) == 1)
12497c478bd9Sstevel@tonic-gate 		nrd = (nrd & 0x1e) | 0x20;
12507c478bd9Sstevel@tonic-gate 
12517c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
12527c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
12537c478bd9Sstevel@tonic-gate 
12545892374fSdf 	r = pfpsd->fp_current_read_gsr(fp);
12557c478bd9Sstevel@tonic-gate 	ao = (int)GSR_ALIGN(r);
12567c478bd9Sstevel@tonic-gate 
12577c478bd9Sstevel@tonic-gate 	for (i = 0, j = ao, k = 0; i <= 7; i++)
12587c478bd9Sstevel@tonic-gate 		if (j <= 7) {
12597c478bd9Sstevel@tonic-gate 			lrd.c[i] = lrs1.c[j++];
12607c478bd9Sstevel@tonic-gate 		} else {
12617c478bd9Sstevel@tonic-gate 			lrd.c[i] = lrs2.c[k++];
12627c478bd9Sstevel@tonic-gate 		}
12637c478bd9Sstevel@tonic-gate 	_fp_pack_extword(pfpsd, &lrd.ll, nrd);
12647c478bd9Sstevel@tonic-gate 
12657c478bd9Sstevel@tonic-gate 	return (ftt_none);
12667c478bd9Sstevel@tonic-gate }
12677c478bd9Sstevel@tonic-gate 
12687c478bd9Sstevel@tonic-gate /*
12697c478bd9Sstevel@tonic-gate  * Simulator for bshuffle instruction.
12707c478bd9Sstevel@tonic-gate  */
12717c478bd9Sstevel@tonic-gate static enum ftt_type
12727c478bd9Sstevel@tonic-gate vis_bshuffle(
12737c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
12747c478bd9Sstevel@tonic-gate 	fp_inst_type	pinst,	/* FPU instruction to simulate. */
12757c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
12767c478bd9Sstevel@tonic-gate {
12777c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
12787c478bd9Sstevel@tonic-gate 	int	i, j, ao;
12797c478bd9Sstevel@tonic-gate 	union {
12807c478bd9Sstevel@tonic-gate 		uint64_t	ll;
12817c478bd9Sstevel@tonic-gate 		uint8_t		c[8];
12827c478bd9Sstevel@tonic-gate 	} lrs1, lrs2, lrd;
12837c478bd9Sstevel@tonic-gate 	uint64_t r;
12847c478bd9Sstevel@tonic-gate 
12857c478bd9Sstevel@tonic-gate 	VISINFO_KSTAT(vis_bshuffle);
12867c478bd9Sstevel@tonic-gate 	nrs1 = pinst.rs1;
12877c478bd9Sstevel@tonic-gate 	nrs2 = pinst.rs2;
12887c478bd9Sstevel@tonic-gate 	nrd = pinst.rd;
12897c478bd9Sstevel@tonic-gate 	if ((nrs1 & 1) == 1) 		/* fix register encoding */
12907c478bd9Sstevel@tonic-gate 		nrs1 = (nrs1 & 0x1e) | 0x20;
12917c478bd9Sstevel@tonic-gate 	if ((nrs2 & 1) == 1)
12927c478bd9Sstevel@tonic-gate 		nrs2 = (nrs2 & 0x1e) | 0x20;
12937c478bd9Sstevel@tonic-gate 	if ((nrd & 1) == 1)
12947c478bd9Sstevel@tonic-gate 		nrd = (nrd & 0x1e) | 0x20;
12957c478bd9Sstevel@tonic-gate 
12967c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &lrs1.ll, nrs1);
12977c478bd9Sstevel@tonic-gate 	_fp_unpack_extword(pfpsd, &lrs2.ll, nrs2);
12987c478bd9Sstevel@tonic-gate 
12995892374fSdf 	r = pfpsd->fp_current_read_gsr(fp);
13007c478bd9Sstevel@tonic-gate 	ao = (int)GSR_MASK(r);
13017c478bd9Sstevel@tonic-gate 
13027c478bd9Sstevel@tonic-gate 	/*
13037c478bd9Sstevel@tonic-gate 	 * BSHUFFLE Destination Byte Selection
13047c478bd9Sstevel@tonic-gate 	 * rd Byte	Source
13057c478bd9Sstevel@tonic-gate 	 * 0		rs byte[GSR.mask<31..28>]
13067c478bd9Sstevel@tonic-gate 	 * 1		rs byte[GSR.mask<27..24>]
13077c478bd9Sstevel@tonic-gate 	 * 2		rs byte[GSR.mask<23..20>]
13087c478bd9Sstevel@tonic-gate 	 * 3		rs byte[GSR.mask<19..16>]
13097c478bd9Sstevel@tonic-gate 	 * 4		rs byte[GSR.mask<15..12>]
13107c478bd9Sstevel@tonic-gate 	 * 5		rs byte[GSR.mask<11..8>]
13117c478bd9Sstevel@tonic-gate 	 * 6		rs byte[GSR.mask<7..4>]
13127c478bd9Sstevel@tonic-gate 	 * 7		rs byte[GSR.mask<3..0>]
13137c478bd9Sstevel@tonic-gate 	 * P.S. rs1 is the upper half and rs2 is the lower half
13147c478bd9Sstevel@tonic-gate 	 * Bytes in the source value are numbered from most to
13157c478bd9Sstevel@tonic-gate 	 * least significant
13167c478bd9Sstevel@tonic-gate 	 */
13177c478bd9Sstevel@tonic-gate 	for (i = 7; i >= 0; i--, ao = (ao >> 4)) {
13187c478bd9Sstevel@tonic-gate 		j = ao & 0xf;		/* get byte number */
13197c478bd9Sstevel@tonic-gate 		if (j < 8) {
13207c478bd9Sstevel@tonic-gate 			lrd.c[i] = lrs1.c[j];
13217c478bd9Sstevel@tonic-gate 		} else {
13227c478bd9Sstevel@tonic-gate 			lrd.c[i] = lrs2.c[j - 8];
13237c478bd9Sstevel@tonic-gate 		}
13247c478bd9Sstevel@tonic-gate 	}
13257c478bd9Sstevel@tonic-gate 	_fp_pack_extword(pfpsd, &lrd.ll, nrd);
13267c478bd9Sstevel@tonic-gate 
13277c478bd9Sstevel@tonic-gate 	return (ftt_none);
13287c478bd9Sstevel@tonic-gate }
13297c478bd9Sstevel@tonic-gate 
13307c478bd9Sstevel@tonic-gate /*
13317c478bd9Sstevel@tonic-gate  * Simulator for siam instruction.
13327c478bd9Sstevel@tonic-gate  */
13337c478bd9Sstevel@tonic-gate static enum ftt_type
13347c478bd9Sstevel@tonic-gate vis_siam(
13357c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
13367c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* FPU instruction to simulate. */
13377c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
13387c478bd9Sstevel@tonic-gate {
13397c478bd9Sstevel@tonic-gate 	uint_t	nrs2;			/* Register number fields. */
13407c478bd9Sstevel@tonic-gate 	uint64_t g, r;
13417c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
13427c478bd9Sstevel@tonic-gate 
13435892374fSdf 	g = pfpsd->fp_current_read_gsr(fp);
13447c478bd9Sstevel@tonic-gate 	g &= ~(GSR_IM_IRND_MASK);	/* zero the IM and IRND fields */
13457c478bd9Sstevel@tonic-gate 	r = nrs2 & 0x7;			/* get mode(3 bit) */
13467c478bd9Sstevel@tonic-gate 	g |= (r << GSR_IRND_SHIFT);
13475892374fSdf 	pfpsd->fp_current_write_gsr(g, fp);
13487c478bd9Sstevel@tonic-gate 	return (ftt_none);
13497c478bd9Sstevel@tonic-gate }
13507c478bd9Sstevel@tonic-gate 
13517c478bd9Sstevel@tonic-gate /*
13527c478bd9Sstevel@tonic-gate  * Simulator for VIS loads and stores between floating-point unit and memory.
13537c478bd9Sstevel@tonic-gate  */
13547c478bd9Sstevel@tonic-gate enum ftt_type
13557c478bd9Sstevel@tonic-gate vis_fldst(
13567c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
13577c478bd9Sstevel@tonic-gate 	fp_inst_type	pinst,	/* FPU instruction to simulate. */
13587c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
13597c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
13607c478bd9Sstevel@tonic-gate 	uint_t		asi)	/* asi to emulate! */
13617c478bd9Sstevel@tonic-gate {
13627c478bd9Sstevel@tonic-gate 	union {
13637c478bd9Sstevel@tonic-gate 		vis_inst_type	inst;
13647c478bd9Sstevel@tonic-gate 		fp_inst_type	pinst;
13657c478bd9Sstevel@tonic-gate 	} i;
13667c478bd9Sstevel@tonic-gate 
13677c478bd9Sstevel@tonic-gate 	ASSERT(USERMODE(pregs->r_tstate));
13687c478bd9Sstevel@tonic-gate 	i.pinst = pinst;
13697c478bd9Sstevel@tonic-gate 	switch (asi) {
13707c478bd9Sstevel@tonic-gate 		case ASI_PST8_P:
13717c478bd9Sstevel@tonic-gate 		case ASI_PST8_S:
13727c478bd9Sstevel@tonic-gate 		case ASI_PST16_P:
13737c478bd9Sstevel@tonic-gate 		case ASI_PST16_S:
13747c478bd9Sstevel@tonic-gate 		case ASI_PST32_P:
13757c478bd9Sstevel@tonic-gate 		case ASI_PST32_S:
13767c478bd9Sstevel@tonic-gate 		case ASI_PST8_PL:
13777c478bd9Sstevel@tonic-gate 		case ASI_PST8_SL:
13787c478bd9Sstevel@tonic-gate 		case ASI_PST16_PL:
13797c478bd9Sstevel@tonic-gate 		case ASI_PST16_SL:
13807c478bd9Sstevel@tonic-gate 		case ASI_PST32_PL:
13817c478bd9Sstevel@tonic-gate 		case ASI_PST32_SL:
13827c478bd9Sstevel@tonic-gate 			return (vis_prtl_fst(pfpsd, i.inst, pregs,
1383*b1b05f9eSarutz 			    prw, asi));
13847c478bd9Sstevel@tonic-gate 		case ASI_FL8_P:
13857c478bd9Sstevel@tonic-gate 		case ASI_FL8_S:
13867c478bd9Sstevel@tonic-gate 		case ASI_FL8_PL:
13877c478bd9Sstevel@tonic-gate 		case ASI_FL8_SL:
13887c478bd9Sstevel@tonic-gate 		case ASI_FL16_P:
13897c478bd9Sstevel@tonic-gate 		case ASI_FL16_S:
13907c478bd9Sstevel@tonic-gate 		case ASI_FL16_PL:
13917c478bd9Sstevel@tonic-gate 		case ASI_FL16_SL:
13927c478bd9Sstevel@tonic-gate 			return (vis_short_fls(pfpsd, i.inst, pregs,
1393*b1b05f9eSarutz 			    prw, asi));
13947c478bd9Sstevel@tonic-gate 		case ASI_BLK_AIUP:
13957c478bd9Sstevel@tonic-gate 		case ASI_BLK_AIUS:
13967c478bd9Sstevel@tonic-gate 		case ASI_BLK_AIUPL:
13977c478bd9Sstevel@tonic-gate 		case ASI_BLK_AIUSL:
13987c478bd9Sstevel@tonic-gate 		case ASI_BLK_P:
13997c478bd9Sstevel@tonic-gate 		case ASI_BLK_S:
14007c478bd9Sstevel@tonic-gate 		case ASI_BLK_PL:
14017c478bd9Sstevel@tonic-gate 		case ASI_BLK_SL:
14027c478bd9Sstevel@tonic-gate 		case ASI_BLK_COMMIT_P:
14037c478bd9Sstevel@tonic-gate 		case ASI_BLK_COMMIT_S:
14047c478bd9Sstevel@tonic-gate 			return (vis_blk_fldst(pfpsd, i.inst, pregs,
1405*b1b05f9eSarutz 			    prw, asi));
14067c478bd9Sstevel@tonic-gate 		default:
14077c478bd9Sstevel@tonic-gate 			return (ftt_unimplemented);
14087c478bd9Sstevel@tonic-gate 	}
14097c478bd9Sstevel@tonic-gate }
14107c478bd9Sstevel@tonic-gate 
14117c478bd9Sstevel@tonic-gate /*
14127c478bd9Sstevel@tonic-gate  * Simulator for partial stores between floating-point unit and memory.
14137c478bd9Sstevel@tonic-gate  */
14147c478bd9Sstevel@tonic-gate static enum ftt_type
14157c478bd9Sstevel@tonic-gate vis_prtl_fst(
14167c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
14177c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* ISE instruction to simulate. */
14187c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
14197c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
14207c478bd9Sstevel@tonic-gate 	uint_t		asi)	/* asi to emulate! */
14217c478bd9Sstevel@tonic-gate {
14227c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
14237c478bd9Sstevel@tonic-gate 	uint_t	opf, msk;
14247c478bd9Sstevel@tonic-gate 	int	h, i, j;
14257c478bd9Sstevel@tonic-gate 	uint64_t ea, tmsk;
14267c478bd9Sstevel@tonic-gate 	union {
14277c478bd9Sstevel@tonic-gate 		freg_type	f;
14287c478bd9Sstevel@tonic-gate 		uint64_t	ll;
14297c478bd9Sstevel@tonic-gate 		uint32_t	i[2];
14307c478bd9Sstevel@tonic-gate 		uint16_t	s[4];
14317c478bd9Sstevel@tonic-gate 		uint8_t		c[8];
14327c478bd9Sstevel@tonic-gate 	} k, l, res;
14337c478bd9Sstevel@tonic-gate 	enum ftt_type   ftt;
14347c478bd9Sstevel@tonic-gate 
14357c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
14367c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
14377c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
14387c478bd9Sstevel@tonic-gate 	if ((nrd & 1) == 1) 		/* fix register encoding */
14397c478bd9Sstevel@tonic-gate 		nrd = (nrd & 0x1e) | 0x20;
14407c478bd9Sstevel@tonic-gate 	opf = inst.opf;
14417c478bd9Sstevel@tonic-gate 	res.ll = 0;
14427c478bd9Sstevel@tonic-gate 	if ((opf & 0x100) == 0) {	/* effective address = rs1  */
14437c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs1, pregs, prw, &ea);
14447c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
14457c478bd9Sstevel@tonic-gate 			return (ftt);
14467c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs2, pregs, prw, &tmsk);
14477c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
14487c478bd9Sstevel@tonic-gate 			return (ftt);
14497c478bd9Sstevel@tonic-gate 		msk = (uint_t)tmsk;
14507c478bd9Sstevel@tonic-gate 	} else {
14517c478bd9Sstevel@tonic-gate 		pfpsd->fp_trapaddr = (caddr_t)pregs->r_pc;
14527c478bd9Sstevel@tonic-gate 		return (ftt_unimplemented);
14537c478bd9Sstevel@tonic-gate 	}
14547c478bd9Sstevel@tonic-gate 
14557c478bd9Sstevel@tonic-gate 	pfpsd->fp_trapaddr = (caddr_t)ea; /* setup bad addr in case we trap */
14567c478bd9Sstevel@tonic-gate 	if ((ea & 0x3) != 0)
14577c478bd9Sstevel@tonic-gate 		return (ftt_alignment);	/* Require 32 bit-alignment. */
14587c478bd9Sstevel@tonic-gate 
14597c478bd9Sstevel@tonic-gate 	switch (asi) {
14607c478bd9Sstevel@tonic-gate 	case ASI_PST8_P:
14617c478bd9Sstevel@tonic-gate 	case ASI_PST8_S:
14627c478bd9Sstevel@tonic-gate 		ftt = _fp_read_extword((uint64_t *)ea, &l.ll, pfpsd);
14637c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
14647c478bd9Sstevel@tonic-gate 			return (ftt);
14657c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
14667c478bd9Sstevel@tonic-gate 		for (i = 0, j = 0x80; i <= 7; i++, j >>= 1) {
14677c478bd9Sstevel@tonic-gate 			if ((msk & j) == j)
14687c478bd9Sstevel@tonic-gate 				res.c[i] = k.c[i];
14697c478bd9Sstevel@tonic-gate 			else
14707c478bd9Sstevel@tonic-gate 				res.c[i] = l.c[i];
14717c478bd9Sstevel@tonic-gate 		}
14727c478bd9Sstevel@tonic-gate 		ftt = _fp_write_extword((uint64_t *)ea, res.ll, pfpsd);
14737c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
14747c478bd9Sstevel@tonic-gate 			return (ftt);
14757c478bd9Sstevel@tonic-gate 		break;
14767c478bd9Sstevel@tonic-gate 	case ASI_PST8_PL:	/* little-endian */
14777c478bd9Sstevel@tonic-gate 	case ASI_PST8_SL:
14787c478bd9Sstevel@tonic-gate 		ftt = _fp_read_extword((uint64_t *)ea, &l.ll, pfpsd);
14797c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
14807c478bd9Sstevel@tonic-gate 			return (ftt);
14817c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
1482428cee1bSjfrank 		for (h = 7, i = 0, j = 1; i <= 7; h--, i++, j <<= 1) {
14837c478bd9Sstevel@tonic-gate 			if ((msk & j) == j)
1484428cee1bSjfrank 				res.c[i] = k.c[h];
14857c478bd9Sstevel@tonic-gate 			else
1486428cee1bSjfrank 				res.c[i] = l.c[i];
14877c478bd9Sstevel@tonic-gate 		}
14887c478bd9Sstevel@tonic-gate 		ftt = _fp_write_extword((uint64_t *)ea, res.ll, pfpsd);
14897c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
14907c478bd9Sstevel@tonic-gate 			return (ftt);
14917c478bd9Sstevel@tonic-gate 		break;
14927c478bd9Sstevel@tonic-gate 	case ASI_PST16_P:
14937c478bd9Sstevel@tonic-gate 	case ASI_PST16_S:
14947c478bd9Sstevel@tonic-gate 		ftt = _fp_read_extword((uint64_t *)ea, &l.ll, pfpsd);
14957c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
14967c478bd9Sstevel@tonic-gate 			return (ftt);
14977c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
14987c478bd9Sstevel@tonic-gate 		for (i = 0, j = 0x8; i <= 3; i++, j >>= 1) {
14997c478bd9Sstevel@tonic-gate 			if ((msk & j) == j)
15007c478bd9Sstevel@tonic-gate 				res.s[i] = k.s[i];
15017c478bd9Sstevel@tonic-gate 			else
15027c478bd9Sstevel@tonic-gate 				res.s[i] = l.s[i];
15037c478bd9Sstevel@tonic-gate 		}
15047c478bd9Sstevel@tonic-gate 		ftt = _fp_write_extword((uint64_t *)ea, res.ll, pfpsd);
15057c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
15067c478bd9Sstevel@tonic-gate 			return (ftt);
15077c478bd9Sstevel@tonic-gate 		break;
15087c478bd9Sstevel@tonic-gate 	case ASI_PST16_PL:
15097c478bd9Sstevel@tonic-gate 	case ASI_PST16_SL:
15107c478bd9Sstevel@tonic-gate 		ftt = _fp_read_extword((uint64_t *)ea, &l.ll, pfpsd);
15117c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
15127c478bd9Sstevel@tonic-gate 			return (ftt);
15137c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
1514428cee1bSjfrank 		for (h = 7, i = 0, j = 1; i <= 6; h -= 2, i += 2, j <<= 1) {
15157c478bd9Sstevel@tonic-gate 			if ((msk & j) == j) {
1516428cee1bSjfrank 				res.c[i] = k.c[h];
1517428cee1bSjfrank 				res.c[i+1] = k.c[h-1];
15187c478bd9Sstevel@tonic-gate 			} else {
1519428cee1bSjfrank 				res.c[i] = l.c[i];
1520428cee1bSjfrank 				res.c[i+1] = l.c[i+1];
15217c478bd9Sstevel@tonic-gate 			}
15227c478bd9Sstevel@tonic-gate 		}
15237c478bd9Sstevel@tonic-gate 		ftt = _fp_write_extword((uint64_t *)ea, res.ll, pfpsd);
15247c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
15257c478bd9Sstevel@tonic-gate 			return (ftt);
15267c478bd9Sstevel@tonic-gate 		break;
15277c478bd9Sstevel@tonic-gate 	case ASI_PST32_P:
15287c478bd9Sstevel@tonic-gate 	case ASI_PST32_S:
15297c478bd9Sstevel@tonic-gate 		ftt = _fp_read_extword((uint64_t *)ea, &l.ll, pfpsd);
15307c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
15317c478bd9Sstevel@tonic-gate 			return (ftt);
15327c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
15337c478bd9Sstevel@tonic-gate 		for (i = 0, j = 0x2; i <= 1; i++, j >>= 1) {
15347c478bd9Sstevel@tonic-gate 			if ((msk & j) == j)
15357c478bd9Sstevel@tonic-gate 				res.i[i] = k.i[i];
15367c478bd9Sstevel@tonic-gate 			else
15377c478bd9Sstevel@tonic-gate 				res.i[i] = l.i[i];
15387c478bd9Sstevel@tonic-gate 		}
15397c478bd9Sstevel@tonic-gate 		ftt = _fp_write_extword((uint64_t *)ea, res.ll, pfpsd);
15407c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
15417c478bd9Sstevel@tonic-gate 			return (ftt);
15427c478bd9Sstevel@tonic-gate 		break;
15437c478bd9Sstevel@tonic-gate 	case ASI_PST32_PL:
15447c478bd9Sstevel@tonic-gate 	case ASI_PST32_SL:
15457c478bd9Sstevel@tonic-gate 		ftt = _fp_read_extword((uint64_t *)ea, &l.ll, pfpsd);
15467c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
15477c478bd9Sstevel@tonic-gate 			return (ftt);
15487c478bd9Sstevel@tonic-gate 		_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
1549428cee1bSjfrank 		for (h = 7, i = 0, j = 1; i <= 4; h -= 4, i += 4, j <<= 1) {
15507c478bd9Sstevel@tonic-gate 			if ((msk & j) == j) {
1551428cee1bSjfrank 				res.c[i] = k.c[h];
1552428cee1bSjfrank 				res.c[i+1] = k.c[h-1];
1553428cee1bSjfrank 				res.c[i+2] = k.c[h-2];
1554428cee1bSjfrank 				res.c[i+3] = k.c[h-3];
15557c478bd9Sstevel@tonic-gate 			} else {
1556428cee1bSjfrank 				res.c[i] = l.c[i];
1557428cee1bSjfrank 				res.c[i+1] = l.c[i+1];
1558428cee1bSjfrank 				res.c[i+2] = l.c[i+2];
1559428cee1bSjfrank 				res.c[i+3] = l.c[i+3];
15607c478bd9Sstevel@tonic-gate 			}
15617c478bd9Sstevel@tonic-gate 		}
15627c478bd9Sstevel@tonic-gate 		ftt = _fp_write_extword((uint64_t *)ea, res.ll, pfpsd);
15637c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
15647c478bd9Sstevel@tonic-gate 			return (ftt);
15657c478bd9Sstevel@tonic-gate 		break;
15667c478bd9Sstevel@tonic-gate 	}
15677c478bd9Sstevel@tonic-gate 
15687c478bd9Sstevel@tonic-gate 	pregs->r_pc = pregs->r_npc;	/* Do not retry emulated instruction. */
15697c478bd9Sstevel@tonic-gate 	pregs->r_npc += 4;
15707c478bd9Sstevel@tonic-gate 	return (ftt_none);
15717c478bd9Sstevel@tonic-gate }
15727c478bd9Sstevel@tonic-gate 
15737c478bd9Sstevel@tonic-gate /*
15747c478bd9Sstevel@tonic-gate  * Simulator for short load/stores between floating-point unit and memory.
15757c478bd9Sstevel@tonic-gate  */
15767c478bd9Sstevel@tonic-gate static enum ftt_type
15777c478bd9Sstevel@tonic-gate vis_short_fls(
15787c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
15797c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* ISE instruction to simulate. */
15807c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
15817c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
15827c478bd9Sstevel@tonic-gate 	uint_t		asi)	/* asi to emulate! */
15837c478bd9Sstevel@tonic-gate {
15847c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
15857c478bd9Sstevel@tonic-gate 	uint_t	opf;
15867c478bd9Sstevel@tonic-gate 	uint64_t ea, tea;
15877c478bd9Sstevel@tonic-gate 	union {
15887c478bd9Sstevel@tonic-gate 		freg_type	f;
15897c478bd9Sstevel@tonic-gate 		uint64_t	ll;
15907c478bd9Sstevel@tonic-gate 		uint32_t	i[2];
15917c478bd9Sstevel@tonic-gate 		uint16_t	s[4];
15927c478bd9Sstevel@tonic-gate 		uint8_t		c[8];
15937c478bd9Sstevel@tonic-gate 	} k;
15947c478bd9Sstevel@tonic-gate 	union {
15957c478bd9Sstevel@tonic-gate 		vis_inst_type	inst;
15967c478bd9Sstevel@tonic-gate 		int		i;
15977c478bd9Sstevel@tonic-gate 	} fp;
15987c478bd9Sstevel@tonic-gate 	enum ftt_type   ftt = ftt_none;
15997c478bd9Sstevel@tonic-gate 	ushort_t us;
16007c478bd9Sstevel@tonic-gate 	uchar_t uc;
16017c478bd9Sstevel@tonic-gate 
16027c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
16037c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
16047c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
16057c478bd9Sstevel@tonic-gate 	if ((nrd & 1) == 1) 		/* fix register encoding */
16067c478bd9Sstevel@tonic-gate 		nrd = (nrd & 0x1e) | 0x20;
16077c478bd9Sstevel@tonic-gate 	opf = inst.opf;
16087c478bd9Sstevel@tonic-gate 	fp.inst = inst;
16097c478bd9Sstevel@tonic-gate 	if ((opf & 0x100) == 0) { /* effective address = rs1 + rs2 */
16107c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs1, pregs, prw, &ea);
16117c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
16127c478bd9Sstevel@tonic-gate 			return (ftt);
16137c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs2, pregs, prw, &tea);
16147c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
16157c478bd9Sstevel@tonic-gate 			return (ftt);
16167c478bd9Sstevel@tonic-gate 		ea += tea;
16177c478bd9Sstevel@tonic-gate 	} else {	/* effective address = rs1 + imm13 */
16187c478bd9Sstevel@tonic-gate 		fp.inst = inst;
16197c478bd9Sstevel@tonic-gate 		ea = (fp.i << 19) >> 19;	/* Extract simm13 field. */
16207c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs1, pregs, prw, &tea);
16217c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
16227c478bd9Sstevel@tonic-gate 			return (ftt);
16237c478bd9Sstevel@tonic-gate 		ea += tea;
16247c478bd9Sstevel@tonic-gate 	}
16257c478bd9Sstevel@tonic-gate 	if (get_udatamodel() == DATAMODEL_ILP32)
16267c478bd9Sstevel@tonic-gate 		ea = (uint64_t)(caddr32_t)ea;
16277c478bd9Sstevel@tonic-gate 
16287c478bd9Sstevel@tonic-gate 	pfpsd->fp_trapaddr = (caddr_t)ea; /* setup bad addr in case we trap */
16297c478bd9Sstevel@tonic-gate 	switch (asi) {
16307c478bd9Sstevel@tonic-gate 	case ASI_FL8_P:
16317c478bd9Sstevel@tonic-gate 	case ASI_FL8_S:
16327c478bd9Sstevel@tonic-gate 	case ASI_FL8_PL:		/* little-endian */
16337c478bd9Sstevel@tonic-gate 	case ASI_FL8_SL:
16347c478bd9Sstevel@tonic-gate 		if ((inst.op3 & 7) == 3) {	/* load byte */
16357c478bd9Sstevel@tonic-gate 			if (fuword8((void *)ea, &uc) == -1)
16367c478bd9Sstevel@tonic-gate 				return (ftt_fault);
16377c478bd9Sstevel@tonic-gate 			k.ll = 0;
16387c478bd9Sstevel@tonic-gate 			k.c[7] = uc;
16397c478bd9Sstevel@tonic-gate 			_fp_pack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
16407c478bd9Sstevel@tonic-gate 		} else {			/* store byte */
16417c478bd9Sstevel@tonic-gate 			_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
16427c478bd9Sstevel@tonic-gate 			uc = k.c[7];
16437c478bd9Sstevel@tonic-gate 			if (subyte((caddr_t)ea, uc) == -1)
16447c478bd9Sstevel@tonic-gate 				return (ftt_fault);
16457c478bd9Sstevel@tonic-gate 		}
16467c478bd9Sstevel@tonic-gate 		break;
16477c478bd9Sstevel@tonic-gate 	case ASI_FL16_P:
16487c478bd9Sstevel@tonic-gate 	case ASI_FL16_S:
16497c478bd9Sstevel@tonic-gate 		if ((ea & 1) == 1)
16507c478bd9Sstevel@tonic-gate 			return (ftt_alignment);
16517c478bd9Sstevel@tonic-gate 		if ((inst.op3 & 7) == 3) {	/* load short */
16527c478bd9Sstevel@tonic-gate 			if (fuword16((void *)ea, &us) == -1)
16537c478bd9Sstevel@tonic-gate 				return (ftt_fault);
16547c478bd9Sstevel@tonic-gate 			k.ll = 0;
16557c478bd9Sstevel@tonic-gate 			k.s[3] = us;
16567c478bd9Sstevel@tonic-gate 			_fp_pack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
16577c478bd9Sstevel@tonic-gate 		} else {			/* store short */
16587c478bd9Sstevel@tonic-gate 			_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
16597c478bd9Sstevel@tonic-gate 			us = k.s[3];
16607c478bd9Sstevel@tonic-gate 			if (suword16((caddr_t)ea, us) == -1)
16617c478bd9Sstevel@tonic-gate 				return (ftt_fault);
16627c478bd9Sstevel@tonic-gate 		}
16637c478bd9Sstevel@tonic-gate 		break;
16647c478bd9Sstevel@tonic-gate 	case ASI_FL16_PL:		/* little-endian */
16657c478bd9Sstevel@tonic-gate 	case ASI_FL16_SL:
16667c478bd9Sstevel@tonic-gate 		if ((ea & 1) == 1)
16677c478bd9Sstevel@tonic-gate 			return (ftt_alignment);
16687c478bd9Sstevel@tonic-gate 		if ((inst.op3 & 7) == 3) {	/* load short */
16697c478bd9Sstevel@tonic-gate 			if (fuword16((void *)ea, &us) == -1)
16707c478bd9Sstevel@tonic-gate 				return (ftt_fault);
16717c478bd9Sstevel@tonic-gate 			k.ll = 0;
16727c478bd9Sstevel@tonic-gate 			k.c[6] = (uchar_t)us;
16737c478bd9Sstevel@tonic-gate 			k.c[7] = (uchar_t)((us & 0xff00) >> 8);
16747c478bd9Sstevel@tonic-gate 			_fp_pack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
16757c478bd9Sstevel@tonic-gate 		} else {			/* store short */
16767c478bd9Sstevel@tonic-gate 			_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD, nrd);
16777c478bd9Sstevel@tonic-gate 			uc = k.c[7];
16787c478bd9Sstevel@tonic-gate 			us = (ushort_t)((uc << 8) | k.c[6]);
16797c478bd9Sstevel@tonic-gate 			if (suword16((void *)ea, us) == -1)
16807c478bd9Sstevel@tonic-gate 				return (ftt_fault);
16817c478bd9Sstevel@tonic-gate 		}
16827c478bd9Sstevel@tonic-gate 		break;
16837c478bd9Sstevel@tonic-gate 	}
16847c478bd9Sstevel@tonic-gate 
16857c478bd9Sstevel@tonic-gate 	pregs->r_pc = pregs->r_npc;	/* Do not retry emulated instruction. */
16867c478bd9Sstevel@tonic-gate 	pregs->r_npc += 4;
16877c478bd9Sstevel@tonic-gate 	return (ftt_none);
16887c478bd9Sstevel@tonic-gate }
16897c478bd9Sstevel@tonic-gate 
16907c478bd9Sstevel@tonic-gate /*
16917c478bd9Sstevel@tonic-gate  * Simulator for block loads and stores between floating-point unit and memory.
16925ccb2ff8Swh  * We pass the addrees of ea to sync_data_memory() to flush the Ecache.
16935ccb2ff8Swh  * Sync_data_memory() calls platform dependent code to flush the Ecache.
16947c478bd9Sstevel@tonic-gate  */
16957c478bd9Sstevel@tonic-gate static enum ftt_type
16967c478bd9Sstevel@tonic-gate vis_blk_fldst(
16977c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
16987c478bd9Sstevel@tonic-gate 	vis_inst_type	inst,	/* ISE instruction to simulate. */
16997c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
17007c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
17017c478bd9Sstevel@tonic-gate 	uint_t		asi)	/* asi to emulate! */
17027c478bd9Sstevel@tonic-gate {
17037c478bd9Sstevel@tonic-gate 	uint_t	nrs1, nrs2, nrd;	/* Register number fields. */
17047c478bd9Sstevel@tonic-gate 	uint_t	opf, h, i, j;
17057c478bd9Sstevel@tonic-gate 	uint64_t ea, tea;
17067c478bd9Sstevel@tonic-gate 	union {
17077c478bd9Sstevel@tonic-gate 		freg_type	f;
17087c478bd9Sstevel@tonic-gate 		uint64_t	ll;
17097c478bd9Sstevel@tonic-gate 		uint8_t		c[8];
17107c478bd9Sstevel@tonic-gate 	} k, l;
17117c478bd9Sstevel@tonic-gate 	union {
17127c478bd9Sstevel@tonic-gate 		vis_inst_type	inst;
17137c478bd9Sstevel@tonic-gate 		int32_t		i;
17147c478bd9Sstevel@tonic-gate 	} fp;
17157c478bd9Sstevel@tonic-gate 	enum ftt_type   ftt;
17167c478bd9Sstevel@tonic-gate 	boolean_t little_endian = B_FALSE;
17177c478bd9Sstevel@tonic-gate 
17187c478bd9Sstevel@tonic-gate 	nrs1 = inst.rs1;
17197c478bd9Sstevel@tonic-gate 	nrs2 = inst.rs2;
17207c478bd9Sstevel@tonic-gate 	nrd = inst.rd;
17217c478bd9Sstevel@tonic-gate 	if ((nrd & 1) == 1) 		/* fix register encoding */
17227c478bd9Sstevel@tonic-gate 		nrd = (nrd & 0x1e) | 0x20;
17237c478bd9Sstevel@tonic-gate 
17247c478bd9Sstevel@tonic-gate 	/* ensure register is 8-double precision aligned */
17257c478bd9Sstevel@tonic-gate 	if ((nrd & 0xf) != 0)
17267c478bd9Sstevel@tonic-gate 		return (ftt_unimplemented);
17277c478bd9Sstevel@tonic-gate 
17287c478bd9Sstevel@tonic-gate 	opf = inst.opf;
17297c478bd9Sstevel@tonic-gate 	if ((opf & 0x100) == 0) { 	/* effective address = rs1 + rs2 */
17307c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs1, pregs, prw, &ea);
17317c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
17327c478bd9Sstevel@tonic-gate 			return (ftt);
17337c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs2, pregs, prw, &tea);
17347c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
17357c478bd9Sstevel@tonic-gate 			return (ftt);
17367c478bd9Sstevel@tonic-gate 		ea += tea;
17377c478bd9Sstevel@tonic-gate 	} else {			/* effective address = rs1 + imm13 */
17387c478bd9Sstevel@tonic-gate 		fp.inst = inst;
17397c478bd9Sstevel@tonic-gate 		ea = (fp.i << 19) >> 19;	/* Extract simm13 field. */
17407c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs1, pregs, prw, &tea);
17417c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
17427c478bd9Sstevel@tonic-gate 			return (ftt);
17437c478bd9Sstevel@tonic-gate 		ea += tea;
17447c478bd9Sstevel@tonic-gate 	}
17457c478bd9Sstevel@tonic-gate 	if ((ea & 0x3F) != 0)		/* Require 64 byte-alignment. */
17467c478bd9Sstevel@tonic-gate 		return (ftt_alignment);
17477c478bd9Sstevel@tonic-gate 
17487c478bd9Sstevel@tonic-gate 	pfpsd->fp_trapaddr = (caddr_t)ea; /* setup bad addr in case we trap */
17497c478bd9Sstevel@tonic-gate 	switch (asi) {
17507c478bd9Sstevel@tonic-gate 	case ASI_BLK_AIUPL:
17517c478bd9Sstevel@tonic-gate 	case ASI_BLK_AIUSL:
17527c478bd9Sstevel@tonic-gate 	case ASI_BLK_PL:
17537c478bd9Sstevel@tonic-gate 	case ASI_BLK_SL:
17547c478bd9Sstevel@tonic-gate 		little_endian = B_TRUE;
17557c478bd9Sstevel@tonic-gate 		/* FALLTHROUGH */
17567c478bd9Sstevel@tonic-gate 	case ASI_BLK_AIUP:
17577c478bd9Sstevel@tonic-gate 	case ASI_BLK_AIUS:
17587c478bd9Sstevel@tonic-gate 	case ASI_BLK_P:
17597c478bd9Sstevel@tonic-gate 	case ASI_BLK_S:
17607c478bd9Sstevel@tonic-gate 	case ASI_BLK_COMMIT_P:
17617c478bd9Sstevel@tonic-gate 	case ASI_BLK_COMMIT_S:
17627c478bd9Sstevel@tonic-gate 		if ((inst.op3 & 7) == 3) {	/* lddf */
1763*b1b05f9eSarutz 			for (i = 0; i < 8; i++, nrd += 2) {
1764*b1b05f9eSarutz 				ftt = _fp_read_extword((uint64_t *)ea, &k.ll,
1765*b1b05f9eSarutz 				    pfpsd);
1766*b1b05f9eSarutz 				if (ftt != ftt_none)
1767*b1b05f9eSarutz 					return (ftt);
1768*b1b05f9eSarutz 				if (little_endian) {
1769*b1b05f9eSarutz 					for (j = 0, h = 7; j < 8; j++, h--)
1770*b1b05f9eSarutz 						l.c[h] = k.c[j];
1771*b1b05f9eSarutz 					k.ll = l.ll;
1772*b1b05f9eSarutz 				}
1773*b1b05f9eSarutz 				_fp_pack_extword(pfpsd, &k.f.FPU_DREG_FIELD,
1774*b1b05f9eSarutz 				    nrd);
1775*b1b05f9eSarutz 				ea += 8;
17767c478bd9Sstevel@tonic-gate 			}
17777c478bd9Sstevel@tonic-gate 		} else {			/* stdf */
1778*b1b05f9eSarutz 			for (i = 0; i < 8; i++, nrd += 2) {
1779*b1b05f9eSarutz 				_fp_unpack_extword(pfpsd, &k.f.FPU_DREG_FIELD,
1780*b1b05f9eSarutz 				    nrd);
1781*b1b05f9eSarutz 				if (little_endian) {
1782*b1b05f9eSarutz 					for (j = 0, h = 7; j < 8; j++, h--)
1783*b1b05f9eSarutz 						l.c[h] = k.c[j];
1784*b1b05f9eSarutz 					k.ll = l.ll;
1785*b1b05f9eSarutz 				}
1786*b1b05f9eSarutz 				ftt = _fp_write_extword((uint64_t *)ea, k.ll,
1787*b1b05f9eSarutz 				    pfpsd);
1788*b1b05f9eSarutz 				if (ftt != ftt_none)
1789*b1b05f9eSarutz 					return (ftt);
1790*b1b05f9eSarutz 				ea += 8;
17917c478bd9Sstevel@tonic-gate 			}
17927c478bd9Sstevel@tonic-gate 		}
17937c478bd9Sstevel@tonic-gate 		if ((asi == ASI_BLK_COMMIT_P) || (asi == ASI_BLK_COMMIT_S))
17945ccb2ff8Swh 			sync_data_memory((caddr_t)(ea - 64), 64);
17957c478bd9Sstevel@tonic-gate 		break;
17967c478bd9Sstevel@tonic-gate 	default:
17977c478bd9Sstevel@tonic-gate 		/* addr of unimp inst */
17987c478bd9Sstevel@tonic-gate 		pfpsd->fp_trapaddr = (caddr_t)pregs->r_pc;
17997c478bd9Sstevel@tonic-gate 		return (ftt_unimplemented);
18007c478bd9Sstevel@tonic-gate 	}
18017c478bd9Sstevel@tonic-gate 
18027c478bd9Sstevel@tonic-gate 	pregs->r_pc = pregs->r_npc;	/* Do not retry emulated instruction. */
18037c478bd9Sstevel@tonic-gate 	pregs->r_npc += 4;
18047c478bd9Sstevel@tonic-gate 	return (ftt_none);
18057c478bd9Sstevel@tonic-gate }
18067c478bd9Sstevel@tonic-gate 
18077c478bd9Sstevel@tonic-gate /*
18087c478bd9Sstevel@tonic-gate  * Simulator for rd %gsr instruction.
18097c478bd9Sstevel@tonic-gate  */
18107c478bd9Sstevel@tonic-gate enum ftt_type
18117c478bd9Sstevel@tonic-gate vis_rdgsr(
18127c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
18137c478bd9Sstevel@tonic-gate 	fp_inst_type	pinst,	/* FPU instruction to simulate. */
18147c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
18157c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
18167c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
18177c478bd9Sstevel@tonic-gate {
18187c478bd9Sstevel@tonic-gate 	uint_t nrd;
18197c478bd9Sstevel@tonic-gate 	uint64_t r;
18207c478bd9Sstevel@tonic-gate 	enum ftt_type ftt = ftt_none;
18217c478bd9Sstevel@tonic-gate 
18227c478bd9Sstevel@tonic-gate 	nrd = pinst.rd;
18237c478bd9Sstevel@tonic-gate 
18245892374fSdf 	r = pfpsd->fp_current_read_gsr(fp);
18257c478bd9Sstevel@tonic-gate 	ftt = write_iureg(pfpsd, nrd, pregs, prw, &r);
18267c478bd9Sstevel@tonic-gate 	pregs->r_pc = pregs->r_npc;	/* Do not retry emulated instruction. */
18277c478bd9Sstevel@tonic-gate 	pregs->r_npc += 4;
18287c478bd9Sstevel@tonic-gate 	return (ftt);
18297c478bd9Sstevel@tonic-gate }
18307c478bd9Sstevel@tonic-gate 
18317c478bd9Sstevel@tonic-gate /*
18327c478bd9Sstevel@tonic-gate  * Simulator for wr %gsr instruction.
18337c478bd9Sstevel@tonic-gate  */
18347c478bd9Sstevel@tonic-gate enum ftt_type
18357c478bd9Sstevel@tonic-gate vis_wrgsr(
18367c478bd9Sstevel@tonic-gate 	fp_simd_type	*pfpsd,	/* FPU simulator data. */
18377c478bd9Sstevel@tonic-gate 	fp_inst_type	pinst,	/* FPU instruction to simulate. */
18387c478bd9Sstevel@tonic-gate 	struct regs	*pregs,	/* Pointer to PCB image of registers. */
18397c478bd9Sstevel@tonic-gate 	void		*prw,	/* Pointer to locals and ins. */
18407c478bd9Sstevel@tonic-gate 	kfpu_t		*fp)	/* Need to fp to access gsr reg */
18417c478bd9Sstevel@tonic-gate {
18427c478bd9Sstevel@tonic-gate 	uint_t nrs1;
18437c478bd9Sstevel@tonic-gate 	uint64_t r, r1, r2;
18447c478bd9Sstevel@tonic-gate 	enum ftt_type ftt = ftt_none;
18457c478bd9Sstevel@tonic-gate 
18467c478bd9Sstevel@tonic-gate 	nrs1 = pinst.rs1;
18477c478bd9Sstevel@tonic-gate 	ftt = read_iureg(pfpsd, nrs1, pregs, prw, &r1);
18487c478bd9Sstevel@tonic-gate 	if (ftt != ftt_none)
18497c478bd9Sstevel@tonic-gate 		return (ftt);
18507c478bd9Sstevel@tonic-gate 	if (pinst.ibit == 0) {	/* copy the value in r[rs2] */
18517c478bd9Sstevel@tonic-gate 		uint_t nrs2;
18527c478bd9Sstevel@tonic-gate 
18537c478bd9Sstevel@tonic-gate 		nrs2 = pinst.rs2;
18547c478bd9Sstevel@tonic-gate 		ftt = read_iureg(pfpsd, nrs2, pregs, prw, &r2);
18557c478bd9Sstevel@tonic-gate 		if (ftt != ftt_none)
18567c478bd9Sstevel@tonic-gate 			return (ftt);
18577c478bd9Sstevel@tonic-gate 	} else {	/* use sign_ext(simm13) */
18587c478bd9Sstevel@tonic-gate 		union {
18597c478bd9Sstevel@tonic-gate 			fp_inst_type	inst;
18607c478bd9Sstevel@tonic-gate 			uint32_t	i;
18617c478bd9Sstevel@tonic-gate 		} fp;
18627c478bd9Sstevel@tonic-gate 
18637c478bd9Sstevel@tonic-gate 		fp.inst = pinst;		/* Extract simm13 field */
18647c478bd9Sstevel@tonic-gate 		r2 = (fp.i << 19) >> 19;
18657c478bd9Sstevel@tonic-gate 	}
18667c478bd9Sstevel@tonic-gate 	r = r1 ^ r2;
18675892374fSdf 	pfpsd->fp_current_write_gsr(r, fp);
18687c478bd9Sstevel@tonic-gate 	pregs->r_pc = pregs->r_npc;	/* Do not retry emulated instruction. */
18697c478bd9Sstevel@tonic-gate 	pregs->r_npc += 4;
18707c478bd9Sstevel@tonic-gate 	return (ftt);
18717c478bd9Sstevel@tonic-gate }
18727c478bd9Sstevel@tonic-gate 
18737c478bd9Sstevel@tonic-gate /*
18747c478bd9Sstevel@tonic-gate  * This is the loadable module wrapper.
18757c478bd9Sstevel@tonic-gate  */
18767c478bd9Sstevel@tonic-gate #include <sys/errno.h>
18777c478bd9Sstevel@tonic-gate #include <sys/modctl.h>
18787c478bd9Sstevel@tonic-gate 
18797c478bd9Sstevel@tonic-gate /*
18807c478bd9Sstevel@tonic-gate  * Module linkage information for the kernel.
18817c478bd9Sstevel@tonic-gate  */
18827c478bd9Sstevel@tonic-gate extern struct mod_ops mod_miscops;
18837c478bd9Sstevel@tonic-gate 
18847c478bd9Sstevel@tonic-gate static struct modlmisc modlmisc = {
18857c478bd9Sstevel@tonic-gate 	&mod_miscops,
18867c478bd9Sstevel@tonic-gate 	"vis fp simulation",
18877c478bd9Sstevel@tonic-gate };
18887c478bd9Sstevel@tonic-gate 
18897c478bd9Sstevel@tonic-gate static struct modlinkage modlinkage = {
18907c478bd9Sstevel@tonic-gate 	MODREV_1, (void *)&modlmisc, NULL
18917c478bd9Sstevel@tonic-gate };
18927c478bd9Sstevel@tonic-gate 
18937c478bd9Sstevel@tonic-gate int
18947c478bd9Sstevel@tonic-gate _init(void)
18957c478bd9Sstevel@tonic-gate {
18967c478bd9Sstevel@tonic-gate 	return (mod_install(&modlinkage));
18977c478bd9Sstevel@tonic-gate }
18987c478bd9Sstevel@tonic-gate 
18997c478bd9Sstevel@tonic-gate int
19007c478bd9Sstevel@tonic-gate _info(struct modinfo *modinfop)
19017c478bd9Sstevel@tonic-gate {
19027c478bd9Sstevel@tonic-gate 	return (mod_info(&modlinkage, modinfop));
19037c478bd9Sstevel@tonic-gate }
1904