1 files changed, 24 insertions, 1 deletions
diff --git a/firmware/test/i2s/i2stest.c b/firmware/test/i2s/i2stest.c
index 16ea291..31f5c20 100644
--- a/firmware/test/i2s/i2stest.c
+++ b/firmware/test/i2s/i2stest.c
@@ -25,13 +25,36 @@
  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA.
  */
 #include <i2s.h>
+#include <led.h>
+
+#include "../test.h"
 
 int main (void)
 {
-  i2s_init();
+  led_init();    
+
+  // From: tools/clkcalc 48000 16 2
+  int pclkdiv = 1;
+  int bitrate = 24;
+  int x = 96;
+  int y = 125;
+
+  int bitwidth = 16;
+  int channels = 2;
+
+  int res = i2s_init(pclkdiv, bitrate, x, y, bitwidth, channels);
+
+  if(res) error();
 
   i2s_tx_start();
 
+  //  success();
+
+  int16_t s = 0;
   while(1) {
+    //while(i2s_get_state_tx_level() < 3) {}
+    i2s_write_pcm_16_stereo(s, s);
+    if((s % 2) == 0) led_toggle();
+    s++;
   }
 }