arch/.unmaintained/arm-all/exec/setsr.c

   1 /*
   2     Copyright © 1995-2001, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: SetSR() - Modify the CPU status register.
   6     Lang: english
   7 */
   8
   9 #include <exec/types.h>
  10 #include <exec/ptrace.h>
  11 #define DEBUG 1
  12 #include <aros/debug.h>
  13
  14 /*****************************************************************************
  15
  16     NAME */
  17 #include <proto/exec.h>
  18
  19         AROS_LH2(ULONG, SetSR,
  20
  21 /*  SYNOPSIS */
  22         AROS_LHA(ULONG, newSR, D0),
  23         AROS_LHA(ULONG, mask,  D1),
  24
  25 /*  LOCATION */
  26         struct ExecBase *, SysBase, 24, Exec)
  27
  28 /*  FUNCTION
  29         Read/Modify the CPU status register in an easy way. Only the bits
  30         set it the mask parameter will be changed.
  31
  32         The bits in the register mapped to those of the Motorola MC680x0
  33         family of microprocessors.
  34
  35     INPUTS
  36         newSR   -   The new contents of the status register.
  37         mask    -   Mask of bits to change.
  38
  39     RESULT
  40         The old contents of the status register or ~0UL if this function
  41         is not implemented.
  42
  43     NOTES
  44         This function is of limited use.
  45
  46     EXAMPLE
  47         You can read the status register by calling SetSR(0,0).
  48
  49     BUGS
  50         This function may do nothing on non-mc680x0 systems.
  51
  52     SEE ALSO
  53
  54     INTERNALS
  55
  56     HISTORY
  57
  58 ******************************************************************************/
  59 {
  60         AROS_LIBFUNC_INIT
  61         ULONG res;
  62
  63         __asm__ __volatile__ ("swi #1");
  64         return res;
  65
  66         AROS_LIBFUNC_EXIT
  67 } /* SetSR() */
  68
  69
  70 void _sys_SetSR(struct pt_regs * regs, LONG adjust)
  71 {
  72         ULONG new  = regs->r0;
  73         ULONG mask = regs->r1;
  74         regs->r0   = regs->cpsr;
  75         regs->cpsr = (regs->cpsr & ~mask) | (new & mask);
  76 //      D(bug("in _sys_SetSR! new cpsr = %x\n",regs->cpsr));
  77 }