ROM2/asm.h

   1 #ifndef _ASM_H_
   2 #define _ASM_H_
   3
   4 #include "types.h"
   5
   6 /* The "g" below really should be an "i", but gcc doesn't believe that it will
   7  * always be an immediate value. Using "g" makes the compiler be quiet, but
   8  * the assembler should fail if the value is not an immediate.
   9  */
  10 extern inline void bset(const void* addr, const u8 mask) {
  11         /* The assembly breaks when gcc tries to optimise consecutive calls to
  12          * bset/bclr on the same memory address. Sigh. Either turn off optimisation
  13          * (-O1 without -Os works), or we do it the dumb way.
  14          */
  15         //*(u8*)addr |= mask;
  16         asm volatile (
  17                 "ldx %0\n"
  18                 "bset 00,x,%1\n"
  19                 : "=m" (addr)              /* outputs */
  20                 : "g" (mask)               /* inputs */
  21                 : "x"                      /* altered registers */
  22         );
  23 }
  24
  25 extern inline void bclr(const void* addr, const u8 mask) {
  26         /* same issue as above */
  27         //*(u8*)addr &= ~mask;
  28         asm volatile (
  29                 "ldx %0\n"
  30                 "bclr 00,x,%1\n"
  31                 : "=m" (addr)              /* outputs */
  32                 : "g" (mask)               /* inputs */
  33                 : "x"                      /* altered registers */
  34         );
  35 }
  36
  37 extern inline void lock() {
  38         asm volatile ("sei");
  39 }
  40
  41 extern inline void unlock() {
  42         asm volatile ("cli");
  43 }
  44
  45 #endif /* _ASM_H_ */