1 files changed, 47 insertions, 2 deletions

diff --git a/firmware/target/arm/as3525/debug-as3525.c b/firmware/target/arm/as3525/debug-as3525.c
index 8a2f8838d6..a08d33e3da 100644
--- a/firmware/target/arm/as3525/debug-as3525.c
+++ b/firmware/target/arm/as3525/debug-as3525.c
@@ -21,15 +21,60 @@
 
 #include <stdbool.h>
 #include "debug-target.h"
+#include "button.h"
+#include "lcd.h"
+#include "font.h"
+#include "system.h"
+#include "sprintf.h"
+
+
+#define _DEBUG_PRINTF(a,varargs...) \
+    snprintf(buf, sizeof(buf), (a), ##varargs); lcd_puts(0,line++,buf)
 
 /* TODO */
 
-bool __dbg_ports(void)
+bool __dbg_hw_info(void)
 {
     return false;
 }
 
-bool __dbg_hw_info(void)
+bool __dbg_ports(void)
 {
+    char buf[50];
+    int line, i;
+    char counter = 0;
+
+    lcd_clear_display();
+    lcd_setfont(FONT_SYSFIXED);
+    char gpio_data[4] = {0,0,0,0};
+
+    while(1)
+    {
+        line = 0;
+        for (i = 0; i < 8; i++)
+        {
+            gpio_data[0] |= GPIOA_PIN(i) & (1<<i);
+            gpio_data[1] |= GPIOB_PIN(i) & (1<<i);
+            gpio_data[2] |= GPIOC_PIN(i) & (1<<i);
+            gpio_data[3] |= GPIOD_PIN(i) & (1<<i);
+        }
+
+        line++;
+        _DEBUG_PRINTF("[GPIO Values and Directions]");
+        _DEBUG_PRINTF("GPIOA: %2x DIR: %2x", gpio_data[0], GPIOA_DIR);
+        _DEBUG_PRINTF("GPIOB: %2x DIR: %2x", gpio_data[1], GPIOB_DIR);
+        _DEBUG_PRINTF("GPIOC: %2x DIR: %2x", gpio_data[2], GPIOC_DIR);
+        _DEBUG_PRINTF("GPIOD: %2x DIR: %2x", gpio_data[3], GPIOD_DIR);
+        line++;
+#ifdef TRACK_DBOP_DIN
+        _DEBUG_PRINTF("[DBOP_DIN]");
+        _DEBUG_PRINTF("DBOP_DIN: %4x", _dbop_din);
+#endif
+        memset(gpio_data, 0, sizeof(gpio_data));
+        lcd_update();
+        if (button_get_w_tmo(HZ/10) == (DEBUG_CANCEL|BUTTON_REL))
+            break;
+    }
+    lcd_setfont(FONT_UI);
     return false;
 }