4 files changed, 30 insertions, 15 deletions
diff --git a/src/stm-demo/ao_demo.c b/src/stm-demo/ao_demo.c
index 24566f9b..a672964b 100644
--- a/src/stm-demo/ao_demo.c
+++ b/src/stm-demo/ao_demo.c
@@ -49,6 +49,7 @@ main(void)
 	ao_cmd_init();
 //	ao_led_init(LEDS_AVAILABLE);
 	ao_lcd_stm_init();
+	ao_lcd_font_init();
 //	ao_add_task(&demo_task, ao_demo, "demo");
 	
 	ao_start_scheduler();
diff --git a/src/stm/ao_arch.h b/src/stm/ao_arch.h
index 96cbfe85..61e62f5d 100644
--- a/src/stm/ao_arch.h
+++ b/src/stm/ao_arch.h
@@ -157,6 +157,8 @@ struct ao_adc {
 
 void ao_lcd_stm_init(void);
 
+void ao_lcd_font_init(void);
+
 void ao_lcd_font_string(char *s);
 
 #endif /* _AO_ARCH_H_ */
diff --git a/src/stm/ao_lcd_font.c b/src/stm/ao_lcd_font.c
index f6074587..2bd787ed 100644
--- a/src/stm/ao_lcd_font.c
+++ b/src/stm/ao_lcd_font.c
@@ -99,3 +99,30 @@ ao_lcd_font_string(char *s) {
 	while (pos < 6)
 		ao_lcd_font_char(pos++, ' ', 0);
 }
+
+static void
+ao_lcd_font_text(void)
+{
+	char	string[20];
+	uint8_t	c = 0;
+	ao_cmd_white();
+	while (ao_cmd_lex_c != '\n' && c < sizeof (string) - 1) {
+		string[c++] = ao_cmd_lex_c;
+		ao_cmd_lex();
+	}
+	string[c++] = '\0';
+	ao_lcd_font_string(string);
+	stm_lcd.sr = (1 << STM_LCD_SR_UDR);
+}
+
+const struct ao_cmds ao_lcd_font_cmds[] = {
+	{ ao_lcd_font_text,	"t <string>\0Write <string> to LCD" },
+	{ 0, NULL }
+};
+
+void
+ao_lcd_font_init(void)
+{
+	ao_cmd_register(ao_lcd_font_cmds);
+}
+	
diff --git a/src/stm/ao_lcd_stm.c b/src/stm/ao_lcd_stm.c
index 2d2fa9b3..f68cf165 100644
--- a/src/stm/ao_lcd_stm.c
+++ b/src/stm/ao_lcd_stm.c
@@ -268,25 +268,10 @@ ao_lcd_stm_clear(void)
 	stm_lcd.sr = (1 << STM_LCD_SR_UDR);
 }
 
-static void
-ao_lcd_stm_text(void)
-{
-	char	string[7];
-	uint8_t	c = 0;
-	ao_cmd_white();
-	while (ao_cmd_lex_c != '\n' && c < sizeof (string)) {
-		string[c++] = ao_cmd_lex_c;
-		ao_cmd_lex();
-	}
-	string[c++] = '\0';
-	ao_lcd_font_string(string);
-	stm_lcd.sr = (1 << STM_LCD_SR_UDR);
-}
 
 const struct ao_cmds ao_lcd_stm_cmds[] = {
 	{ ao_lcd_stm_seg_set,	"s <com> <seg> <value>\0Set LCD segment" },
 	{ ao_lcd_stm_clear,	"C\0Clear LCD" },
-	{ ao_lcd_stm_text,	"t <string>\0Write <string> to LCD" },
 	{ 0, NULL },
 };