From owner-svn-src-head@freebsd.org Fri Nov 6 13:34:31 2020 Return-Path: Delivered-To: svn-src-head@mailman.nyi.freebsd.org Received: from mx1.freebsd.org (mx1.freebsd.org [IPv6:2610:1c1:1:606c::19:1]) by mailman.nyi.freebsd.org (Postfix) with ESMTP id D6AD82EEE5F; Fri, 6 Nov 2020 13:34:31 +0000 (UTC) (envelope-from alfredo@FreeBSD.org) Received: from mxrelay.nyi.freebsd.org (mxrelay.nyi.freebsd.org [IPv6:2610:1c1:1:606c::19:3]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits) key-exchange X25519 server-signature RSA-PSS (4096 bits) server-digest SHA256 client-signature RSA-PSS (4096 bits) client-digest SHA256) (Client CN "mxrelay.nyi.freebsd.org", Issuer "Let's Encrypt Authority X3" (verified OK)) by mx1.freebsd.org (Postfix) with ESMTPS id 4CSLw75mqBz3n3H; Fri, 6 Nov 2020 13:34:31 +0000 (UTC) (envelope-from alfredo@FreeBSD.org) Received: from repo.freebsd.org (repo.freebsd.org [IPv6:2610:1c1:1:6068::e6a:0]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (Client did not present a certificate) by mxrelay.nyi.freebsd.org (Postfix) with ESMTPS id B928225A73; Fri, 6 Nov 2020 13:34:31 +0000 (UTC) (envelope-from alfredo@FreeBSD.org) Received: from repo.freebsd.org ([127.0.1.37]) by repo.freebsd.org (8.15.2/8.15.2) with ESMTP id 0A6DYVBl083101; Fri, 6 Nov 2020 13:34:31 GMT (envelope-from alfredo@FreeBSD.org) Received: (from alfredo@localhost) by repo.freebsd.org (8.15.2/8.15.2/Submit) id 0A6DYUV9083093; Fri, 6 Nov 2020 13:34:30 GMT (envelope-from alfredo@FreeBSD.org) Message-Id: <202011061334.0A6DYUV9083093@repo.freebsd.org> X-Authentication-Warning: repo.freebsd.org: alfredo set sender to alfredo@FreeBSD.org using -f From: "Alfredo Dal'Ava Junior" Date: Fri, 6 Nov 2020 13:34:30 +0000 (UTC) To: src-committers@freebsd.org, svn-src-all@freebsd.org, svn-src-head@freebsd.org Subject: svn commit: r367416 - in head/sys/powerpc: include powerpc X-SVN-Group: head X-SVN-Commit-Author: alfredo X-SVN-Commit-Paths: in head/sys/powerpc: include powerpc X-SVN-Commit-Revision: 367416 X-SVN-Commit-Repository: base MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit X-BeenThere: svn-src-head@freebsd.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: SVN commit messages for the src tree for head/-current List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , X-List-Received-Date: Fri, 06 Nov 2020 13:34:31 -0000 Author: alfredo Date: Fri Nov 6 13:34:30 2020 New Revision: 367416 URL: https://svnweb.freebsd.org/changeset/base/367416 Log: [POWERPC] Floating-Point Exception trap support Add support for Floating-Point Exception traps on 32 and 64 bit platforms. Also make sure to clean FPSCR on EXEC and thread exit Author of initial version: Renato Riolino Reviewed by: jhibbits Sponsored by: Eldorado Research Institute (eldorado.org.br) Differential Revision: https://reviews.freebsd.org/D23623 Modified: head/sys/powerpc/include/cpufunc.h head/sys/powerpc/include/fpu.h head/sys/powerpc/include/psl.h head/sys/powerpc/powerpc/exec_machdep.c head/sys/powerpc/powerpc/fpu.c head/sys/powerpc/powerpc/trap.c Modified: head/sys/powerpc/include/cpufunc.h ============================================================================== --- head/sys/powerpc/include/cpufunc.h Fri Nov 6 07:16:21 2020 (r367415) +++ head/sys/powerpc/include/cpufunc.h Fri Nov 6 13:34:30 2020 (r367416) @@ -163,6 +163,25 @@ mttb(u_quad_t time) mtspr(TBR_TBWL, (uint32_t)(time & 0xffffffff)); } + +static __inline register_t +mffs(void) +{ + register_t value; + + __asm __volatile ("mffs 0; stfd 0,0(%0)" + :: "b"(&value)); + + return (value); +} + +static __inline void +mtfsf(register_t value) +{ + __asm __volatile ("lfd 0,0(%0); mtfsf 0xff,0" + :: "b"(&value)); +} + static __inline void eieio(void) { Modified: head/sys/powerpc/include/fpu.h ============================================================================== --- head/sys/powerpc/include/fpu.h Fri Nov 6 07:16:21 2020 (r367415) +++ head/sys/powerpc/include/fpu.h Fri Nov 6 13:34:30 2020 (r367416) @@ -75,6 +75,8 @@ void enable_fpu(struct thread *); void save_fpu(struct thread *); void save_fpu_nodrop(struct thread *); +void cleanup_fpscr(void); +u_int get_fpu_exception(struct thread *); #endif /* _KERNEL */ Modified: head/sys/powerpc/include/psl.h ============================================================================== --- head/sys/powerpc/include/psl.h Fri Nov 6 07:16:21 2020 (r367415) +++ head/sys/powerpc/include/psl.h Fri Nov 6 13:34:30 2020 (r367416) @@ -88,7 +88,7 @@ #define PSL_FE_NONREC PSL_FE1 /* imprecise non-recoverable */ #define PSL_FE_REC PSL_FE0 /* imprecise recoverable */ #define PSL_FE_PREC (PSL_FE0 | PSL_FE1) /* precise */ -#define PSL_FE_DFLT PSL_FE_DIS /* default == none */ +#define PSL_FE_DFLT PSL_FE_PREC /* default == precise */ #ifndef LOCORE extern register_t psl_kernset; /* Default MSR values for kernel */ Modified: head/sys/powerpc/powerpc/exec_machdep.c ============================================================================== --- head/sys/powerpc/powerpc/exec_machdep.c Fri Nov 6 07:16:21 2020 (r367415) +++ head/sys/powerpc/powerpc/exec_machdep.c Fri Nov 6 13:34:30 2020 (r367416) @@ -239,11 +239,14 @@ sendsig(sig_t catcher, ksiginfo_t *ksi, sigset_t *mask usfp = (void *)((sp - rndfsize) & ~0xFul); } - /* - * Save the floating-point state, if necessary, then copy it. + /* + * Set Floating Point facility to "Ignore Exceptions Mode" so signal + * handler can run. */ - /* XXX */ + if (td->td_pcb->pcb_flags & PCB_FPU) + tf->srr1 = tf->srr1 & ~(PSL_FE0 | PSL_FE1); + /* * Set up the registers to return to sigcode. * @@ -333,6 +336,13 @@ sys_sigreturn(struct thread *td, struct sigreturn_args kern_sigprocmask(td, SIG_SETMASK, &uc.uc_sigmask, NULL, 0); + /* + * Save FPU state if needed. User may have changed it on + * signal handler + */ + if (uc.uc_mcontext.mc_srr1 & PSL_FP) + save_fpu(td); + CTR3(KTR_SIG, "sigreturn: return td=%p pc=%#x sp=%#x", td, uc.uc_mcontext.mc_srr0, uc.uc_mcontext.mc_gpr[1]); @@ -556,6 +566,8 @@ cleanup_power_extras(struct thread *td) mtspr(SPR_FSCR, 0); if (pcb_flags & PCB_CDSCR) mtspr(SPR_DSCRP, 0); + + cleanup_fpscr(); } /* @@ -825,6 +837,14 @@ freebsd32_sigreturn(struct thread *td, struct freebsd3 return (error); kern_sigprocmask(td, SIG_SETMASK, &uc.uc_sigmask, NULL, 0); + + /* + * Save FPU state if needed. User may have changed it on + * signal handler + */ + if (uc.uc_mcontext.mc_srr1 & PSL_FP) + save_fpu(td); + CTR3(KTR_SIG, "sigreturn: return td=%p pc=%#x sp=%#x", td, uc.uc_mcontext.mc_srr0, uc.uc_mcontext.mc_gpr[1]); Modified: head/sys/powerpc/powerpc/fpu.c ============================================================================== --- head/sys/powerpc/powerpc/fpu.c Fri Nov 6 07:16:21 2020 (r367415) +++ head/sys/powerpc/powerpc/fpu.c Fri Nov 6 13:34:30 2020 (r367416) @@ -48,7 +48,7 @@ __FBSDID("$FreeBSD$"); static void save_fpu_int(struct thread *td) { - int msr; + register_t msr; struct pcb *pcb; pcb = td->td_pcb; @@ -102,7 +102,7 @@ save_fpu_int(struct thread *td) void enable_fpu(struct thread *td) { - int msr; + register_t msr; struct pcb *pcb; struct trapframe *tf; @@ -208,3 +208,58 @@ save_fpu_nodrop(struct thread *td) if (td == PCPU_GET(fputhread)) save_fpu_int(td); } + + +/* + * Clear Floating-Point Status and Control Register + */ +void +cleanup_fpscr() +{ + register_t msr; + msr = mfmsr(); + mtmsr(msr | PSL_FP | PSL_VSX); + + mtfsf(0); + + isync(); + mtmsr(msr); +} + + +/* + * * Returns the current fp exception + * */ +u_int +get_fpu_exception(struct thread *td) +{ + register_t msr; + u_int ucode; + register_t reg; + + critical_enter(); + + msr = mfmsr(); + mtmsr(msr | PSL_FP); + + reg = mffs(); + + isync(); + mtmsr(msr); + + critical_exit(); + + if (reg & FPSCR_ZX) + ucode = FPE_FLTDIV; + else if (reg & FPSCR_OX) + ucode = FPE_FLTOVF; + else if (reg & FPSCR_UX) + ucode = FPE_FLTUND; + else if (reg & FPSCR_XX) + ucode = FPE_FLTRES; + else + ucode = FPE_FLTINV; + + return ucode; +} + Modified: head/sys/powerpc/powerpc/trap.c ============================================================================== --- head/sys/powerpc/powerpc/trap.c Fri Nov 6 07:16:21 2020 (r367415) +++ head/sys/powerpc/powerpc/trap.c Fri Nov 6 13:34:30 2020 (r367416) @@ -405,16 +405,24 @@ trap(struct trapframe *frame) #endif sig = SIGTRAP; ucode = TRAP_BRKPT; - } else { + break; + } + + if ((frame->srr1 & EXC_PGM_FPENABLED) && + (td->td_pcb->pcb_flags & PCB_FPU)) + sig = SIGFPE; + else sig = ppc_instr_emulate(frame, td); - if (sig == SIGILL) { - if (frame->srr1 & EXC_PGM_PRIV) - ucode = ILL_PRVOPC; - else if (frame->srr1 & EXC_PGM_ILLEGAL) - ucode = ILL_ILLOPC; - } else if (sig == SIGFPE) - ucode = FPE_FLTINV; /* Punt for now, invalid operation. */ + + if (sig == SIGILL) { + if (frame->srr1 & EXC_PGM_PRIV) + ucode = ILL_PRVOPC; + else if (frame->srr1 & EXC_PGM_ILLEGAL) + ucode = ILL_ILLOPC; + } else if (sig == SIGFPE) { + ucode = get_fpu_exception(td); } + break; case EXC_MCHK: @@ -964,7 +972,7 @@ fix_unaligned(struct thread *td, struct trapframe *fra static void normalize_inputs(void) { - unsigned long msr; + register_t msr; /* enable VSX */ msr = mfmsr();