From 77968061965871d36a8061feeaa1479fdee221a0 Mon Sep 17 00:00:00 2001
From: fenrir <fenrir.naru@gmail.com>
Date: Thu, 25 Feb 2016 20:48:29 +0900
Subject: [PATCH] Fix prohibited register (FLSCL) writing

---
 firmware/f38x_flash.c | 6 +++---
 1 file changed, 3 insertions(+), 3 deletions(-)

diff --git a/firmware/f38x_flash.c b/firmware/f38x_flash.c
index 849dd0d..f9c2654 100644
--- a/firmware/f38x_flash.c
+++ b/firmware/f38x_flash.c
@@ -46,14 +46,14 @@ static void prologue(){
   ea_orig = EA; // Preserve EA
   EA = 0; // Disable interrupts
 
-  FLSCL_orig = FLSCL;
+  FLSCL_orig = FLSCL & 0x90;
   if(SYSCLK > 25000000UL){ // check clock speed
-    FLSCL |= 0x10;
+    FLSCL = (FLSCL_orig | 0x10);
   }
 
   VDM0CN_orig = VDM0CN;
   if(!(VDM0CN & 0x80)){
-    VDM0CN |= 0x80; // Enable VDD monitor
+    VDM0CN = (VDM0CN_orig | 0x80); // Enable VDD monitor
     wait_us(100);
   }
   RSTSRC_orig = RSTSRC & 0xA6;