1 files changed, 124 insertions, 0 deletions

diff --git a/firmware/target/arm/tcc77x/iaudio7/ata2501.c b/firmware/target/arm/tcc77x/iaudio7/ata2501.c
new file mode 100644
index 0000000000..fa165d9d0d
--- /dev/null
+++ b/firmware/target/arm/tcc77x/iaudio7/ata2501.c
@@ -0,0 +1,124 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2008 Vitja Makarov
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+
+#include "config.h"
+#include "cpu.h"
+#include "button.h"
+
+#include "ata2501.h"
+
+#define STB   (1<<5)
+#define SDATA (1<<4)
+#define RESET (1<<6)
+#define SIFMD (1<<7)
+#define STB_DELAY 200
+
+#define udelay _udelay
+
+/* do we really need it? */
+static void _udelay(int cycles)
+{
+    cycles /= 8;
+    while (cycles--) {
+        asm("nop;nop;");
+    }
+}
+
+/*
+  TODO: sensitivity using GPIOS
+*/
+void ata2501_init(void)
+{
+    GPIOD_DIR |= (RESET | STB | SIFMD | (1 << 8) | (1 << 9));
+    GPIOD_DIR &= ~(SDATA);
+
+    GPIOD &= ~RESET;
+    udelay(1000);
+
+    GPIOD |= RESET;
+
+    GPIOD &= ~STB;
+
+#if 1
+    GPIOD &= ~((1 << 9) | (1 << 8));
+    GPIOD |= ((1 << 8) | SIFMD) | (1 << 9);
+#else
+    GPIOD |= ((1 << 9) | (1 << 8));
+    GPIOD &= ~(SIFMD);
+#endif
+}
+
+unsigned short ata2501_read(void)
+{
+    unsigned short ret = 0;
+    int i;
+
+    for (i = 0; i < 12; i++) {
+        GPIOD |= STB;
+        udelay(50);
+
+        ret <<= 1;
+        if (GPIOD & SDATA)
+            ret |= 1;
+        udelay(50);
+        GPIOD &= ~STB;
+        udelay(100);
+    }
+
+    return ret;
+}
+
+#define ATA2501_TEST
+#ifdef ATA2501_TEST
+#include "lcd.h"
+#include "sprintf.h"
+
+static
+void bits(char *str, unsigned short val)
+{
+    int i;
+
+    for (i = 0; i < 12; i++)
+        str[i] = (val & (1 << i)) ? '1' : '0';
+    str[i] = 0;
+}
+
+void ata2501_test(void)
+{
+    char buf[100];
+    ata2501_init();
+
+    while (1) {
+        unsigned short data;
+        int i, line = 0;
+
+        data = ata2501_read();
+        lcd_clear_display();
+        lcd_puts(0, line++, "ATA2501 test");
+
+        bits(buf, data);
+        lcd_puts(0, line++, buf);
+
+        lcd_update();
+        udelay(2000);
+    }
+}
+#endif