Added mas_reset()

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@1196 a1c6a512-1295-4272-9138-f99709370657

1 files changed, 27 insertions, 0 deletions

diff --git a/firmware/drivers/mas.c b/firmware/drivers/mas.c
index c4daed9abf..f13f8aec01 100644
--- a/firmware/drivers/mas.c
+++ b/firmware/drivers/mas.c
@@ -16,9 +16,14 @@
  * KIND, either express or implied.
  *
  ****************************************************************************/
+#include "stdbool.h"
+#include "sh7034.h"
 #include "i2c.h"
 #include "debug.h"
 #include "mas.h"
+#include "kernel.h"
+
+extern bool old_recorder;
 
 static int mas_devread(unsigned long *dest, int len);
 
@@ -260,6 +265,28 @@ static int mas_devread(unsigned long *dest, int len)
 }
 
 #ifdef ARCHOS_RECORDER
+
+void mas_reset(void)
+{
+    PAIOR |= 0x100;
+    
+    if(old_recorder)
+    {
+        /* Older recorder models don't invert the POR signal */
+        PADR |= 0x100;
+        sleep(HZ/100);
+        PADR &= ~0x100;
+        sleep(HZ/5);
+    }
+    else
+    {
+        PADR &= ~0x100;
+        sleep(HZ/100);
+        PADR |= 0x100;
+        sleep(HZ/5);
+    }
+}
+
 int mas_direct_config_read(unsigned char reg)
 {
     int ret = 0;