From 3c0465326247e256232e96bb55bc67e3099666b5 Mon Sep 17 00:00:00 2001
From: Nicolas Pouillon <nipo@ssji.net>
Date: Fri, 11 Nov 2016 17:08:44 +0100
Subject: [PATCH] software/tests: Add brain_eth

---
 software/tests/brain_eth/Makefile |  1 +
 software/tests/brain_eth/config   | 11 ++++++
 software/tests/brain_eth/main.c   | 60 +++++++++++++++++++++++++++++++
 3 files changed, 72 insertions(+)
 create mode 100644 software/tests/brain_eth/Makefile
 create mode 100644 software/tests/brain_eth/config
 create mode 100644 software/tests/brain_eth/main.c

diff --git a/software/tests/brain_eth/Makefile b/software/tests/brain_eth/Makefile
new file mode 100644
index 0000000..85ec727
--- /dev/null
+++ b/software/tests/brain_eth/Makefile
@@ -0,0 +1 @@
+objs += main.o
diff --git a/software/tests/brain_eth/config b/software/tests/brain_eth/config
new file mode 100644
index 0000000..7611549
--- /dev/null
+++ b/software/tests/brain_eth/config
@@ -0,0 +1,11 @@
+%set OUTPUT_NAME brain_eth
+%append MODULES $(OUTPUT_NAME):$(CONFIGPATH)
+
+CONFIG_LICENSE_APP_BSD
+
+%inherit shell
+%inherit bmaaa-brain
+%inherit ethernet
+%include bmaaa.build
+
+CONFIG_APP_START
\ No newline at end of file
diff --git a/software/tests/brain_eth/main.c b/software/tests/brain_eth/main.c
new file mode 100644
index 0000000..743fd38
--- /dev/null
+++ b/software/tests/brain_eth/main.c
@@ -0,0 +1,60 @@
+#include <hexo/iospace.h>
+
+#include <mutek/startup.h>
+#include <mutek/thread.h>
+#include <mutek/printk.h>
+
+#include <drivers/net/dwc10100/dwc10100_mac.h>
+#include <arch/stm32/mmap.h>
+
+static uint16_t smi_read(uint_fast8_t phy,
+                              uint_fast8_t reg)
+{
+  uint16_t val;
+  
+  cpu_mem_write_32(STM32_ETHERNET_MAC_ADDR + DWC_MAC_MIIAR_ADDR, 0
+                   | DWC_MAC_MIIAR_PA(phy)
+                   | DWC_MAC_MIIAR_MR(reg)
+                   | DWC_MAC_MIIAR_MB);
+
+  while (cpu_mem_read_32(STM32_ETHERNET_MAC_ADDR + DWC_MAC_MIIAR_ADDR) & DWC_MAC_MIIAR_MB)
+    ;
+
+  val = cpu_mem_read_32(STM32_ETHERNET_MAC_ADDR + DWC_MAC_MIIDR_ADDR);
+
+  return val;
+}
+
+static void smi_write(uint_fast8_t phy,
+                           uint_fast8_t reg,
+                           uint16_t value)
+{
+  cpu_mem_write_32(STM32_ETHERNET_MAC_ADDR + DWC_MAC_MIIDR_ADDR, value);
+  cpu_mem_write_32(STM32_ETHERNET_MAC_ADDR + DWC_MAC_MIIAR_ADDR, 0
+                   | DWC_MAC_MIIAR_PA(phy)
+                   | DWC_MAC_MIIAR_MR(reg)
+                   | DWC_MAC_MIIAR_MW
+                   | DWC_MAC_MIIAR_MB);
+
+  while (cpu_mem_read_32(STM32_ETHERNET_MAC_ADDR + DWC_MAC_MIIAR_ADDR) & DWC_MAC_MIIAR_MB)
+    ;
+}
+
+static CONTEXT_ENTRY(main)
+{
+    for (uint32_t phy = 0; phy < 32; ++phy) {
+        for (uint32_t reg = 0; reg < 8; ++reg) {
+            printk(" %d: %04x", reg, smi_read(phy, reg));
+        }
+        printk("\n");
+    }
+}
+
+void app_start(void)
+{
+  struct thread_attr_s attr = {
+    .stack_size = 2048,
+  };
+
+  thread_create(main, 0, &attr);
+}
-- 
GitLab