Enough wacky little fixes to get motors turning and keypad functional.

[uccvend-snackrom.git] / ROM2 / vend.h

diff --git a/ROM2/vend.h b/ROM2/vend.h
index c7650ca..11c483d 100644 (file)
--- a/ROM2/vend.h
+++ b/ROM2/vend.h
@@ -13,8 +13,14 @@
        extern volatile u8 _##a;          \
        u8 a; \
        extern inline void set_##a(u8 b) { a = b; _##a = b; } \
-       extern inline void bset_##a(const u8 m) { bset(&a, m); _##a = a; } \
-       extern inline void bclr_##a(const u8 m) { bclr(&a, m); _##a = a; }
+       extern inline void bset_##a(const u8 m) { \
+               bset(&a, m); \
+               asm volatile ( "ldab %1\nstab %0\n" \
+                               : "=m"(_##a) : "m"(a) : "d"); } \
+       extern inline void bclr_##a(const u8 m) { \
+               bclr(&a, m); \
+               asm volatile ( "ldab %1\nstab %0\n" \
+                               : "=m"(_##a) : "m"(a) : "d"); }
 
 buffered_addr(changer_output);
 buffered_addr(misc_output);