add lcd device

git-svn-id: https://rt-thread.googlecode.com/svn/trunk@78 bbd45198-f89e-11dd-88c7-29a3b14d5316

bsp/stm32_radio/application.c

@@ -76,51 +76,28 @@ void rt_key_entry(void *parameter)
     }
 }
 
-#include "fmt0371\fmt0371.h"
-// lcd test routine
-void fmt0371_test(void)
+extern rt_err_t lcd_hw_init(void);
+void rt_lcd_entry(void *parameter)
 {
-    unsigned int color[]={0xf800,0x07e0,0x001f,0xffe0,0x0000,0xffff,0x07ff,0xf81f};
-    unsigned int num;
-    unsigned int n,c;
+    rt_device_t device;
+    unsigned int i,k;
+    unsigned short color[]={0xf800,0x07e0,0x001f,0xffe0,0x0000,0xffff,0x07ff,0xf81f};
 
-    for (c=0;c<8;c++)
-    {
-        LCD_ADDR = 0x02;
-        LCD_DATA = 0x00;
+    lcd_hw_init();
 
-        LCD_ADDR = 0x03;
-        LCD_DATA16(0x0000);
+    device = rt_device_find("lcd");
 
-        LCD_ADDR = 0x0E;
-        for (n=0;n<240;n++)
+    rt_kprintf("Now test the LCD......\r\n");
+    while (1)
     {
-            for (num=0;num<320;num++)
+        for (k=0;k<8;k++)
         {
-                LCD_DATA16(color[c]);
-            }
+            for (i=0;i<320*240;i++)
+            {
+                device->write(device,i*2,&color[k],2);
             }
-        rt_thread_delay(100);
+            rt_thread_delay(RT_TICK_PER_SECOND);
         }
-}
-
-void rt_lcd_entry(void *parameter)
-{
-    GPIO_InitTypeDef GPIO_InitStructure;
-
-    RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOF,ENABLE);
-    GPIO_InitStructure.GPIO_Pin   = GPIO_Pin_9;
-    GPIO_InitStructure.GPIO_Mode  = GPIO_Mode_Out_PP;
-    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
-    GPIO_Init(GPIOF,&GPIO_InitStructure);
-    GPIO_SetBits(GPIOF,GPIO_Pin_9);
-
-    ftm0371_port_init();
-    ftm0371_init();
-    rt_kprintf("Now test the LCD......\r\n");
-    while (1)
-    {
-        fmt0371_test();
     }
 }
 
@@ -129,7 +106,7 @@ void lcd_test()
     rt_thread_t lcd_tid;
     lcd_tid = rt_thread_create("lcd",
                                rt_lcd_entry, RT_NULL,
-		512, 30, 5);
+                               1024, 30, 5);
     if (lcd_tid != RT_NULL) rt_thread_startup(lcd_tid);
 }
 FINSH_FUNCTION_EXPORT(lcd_test, test lcd)
@@ -137,7 +114,7 @@ FINSH_FUNCTION_EXPORT(lcd_test, test lcd)
 /* thread phase init */
 void rt_init_thread_entry(void *parameter)
 {
-/* Filesystem Initialization */
+    /* Filesystem Initialization */
 #ifdef RT_USING_DFS
     {
         /* init the device filesystem */
@@ -153,7 +130,7 @@ void rt_init_thread_entry(void *parameter)
     }
 #endif
 
-/* LwIP Initialization */
+    /* LwIP Initialization */
 #ifdef RT_USING_LWIP
     {
         extern void lwip_sys_init(void);

bsp/stm32_radio/lcd.c

+#include "stm32f10x.h"
+#include "rtthread.h"
+#include "fmt0371/FMT0371.h"
+
+static rt_err_t lcd_init (rt_device_t dev)
+{
+    ftm0371_port_init();
+    ftm0371_init();
+    return RT_EOK;
+}
+
+static rt_err_t lcd_open(rt_device_t dev, rt_uint16_t oflag)
+{
+    return RT_EOK;
+}
+
+static rt_err_t lcd_close(rt_device_t dev)
+{
+    return RT_EOK;
+}
+
+static rt_err_t lcd_control(rt_device_t dev, rt_uint8_t cmd, void *args)
+{
+    /* rate control */
+    return RT_EOK;
+}
+
+static rt_size_t lcd_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
+{
+    unsigned int i;
+    unsigned short *p;
+    unsigned int x,y;
+
+    size = size / 2;
+    y = (pos/2) / 240;
+    x = (pos/2)%240;
+
+    LCD_ADDR = 0x02; // X start point
+    LCD_DATA = x;
+
+    LCD_ADDR = 0x03; // Y start point
+    LCD_DATA16( y );
+
+    LCD_ADDR = 0x0E; // start write
+    p = (unsigned short *) buffer;
+
+    if (size > (240-x))
+    {
+        for (i=0;i<(240-x);i++)
+        {
+            LCD_DATA16(*p++);
+        }
+        LCD_ADDR = 0x02; // X start point
+        LCD_DATA = 0;
+
+        LCD_ADDR = 0x03; // Y start point
+        LCD_DATA16( y+1 );
+        size -= (x+1);
+
+        while (size--)
+        {
+            LCD_DATA16(*p++);
+        }
+    }
+    else
+    {
+        for (i=0;i<size;i++)
+        {
+            LCD_DATA16(*p++);
+        }
+    }
+
+
+    return RT_EOK;
+}
+
+struct rt_device lcd_device;
+rt_err_t lcd_hw_init(void)
+{
+    GPIO_InitTypeDef GPIO_InitStructure;
+
+    RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOF,ENABLE);
+    GPIO_InitStructure.GPIO_Pin   = GPIO_Pin_9;
+    GPIO_InitStructure.GPIO_Mode  = GPIO_Mode_Out_PP;
+    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
+    GPIO_Init(GPIOF,&GPIO_InitStructure);
+    GPIO_SetBits(GPIOF,GPIO_Pin_9);
+
+    ftm0371_port_init();
+    ftm0371_init();
+
+    lcd_device.type           = RT_Device_Class_Block;
+    lcd_device.rx_indicate 	= RT_NULL;
+    lcd_device.tx_complete 	= RT_NULL;
+    lcd_device.init           = lcd_init;
+    lcd_device.open			= lcd_open;
+    lcd_device.close			= lcd_close;
+    lcd_device.read 			= RT_NULL;
+    lcd_device.write 			= lcd_write;
+    lcd_device.control 		= lcd_control;
+    lcd_device.private		= RT_NULL;
+
+    return rt_device_register(&lcd_device, "lcd",RT_DEVICE_FLAG_RDWR);
+}