rt-thread/bsp/ls1cdev/drivers/display_controller.c

/*
 * File      :display_controller.c
 * This file is part of RT-Thread RTOS
 * COPYRIGHT (C) 2006 - 2017, RT-Thread Development Team
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 *
 * Change Logs:
 * Date           Author       	Notes
 * 2011-08-09     lgnq         first version for LS1B DC
 * 2015-07-06    chinesebear   modified for loongson 1c
 * 2018-01-06    sundm75       modified for smartloong 
 */

#include <rtthread.h>
#include "display_controller.h"
#include "../../libraries/ls1c_pwm.h"
#include "../../libraries/ls1c_public.h"
#include "../../libraries/ls1c_gpio.h"

struct vga_struct vga_mode[] =
{
	{/*"480x272_60.00"*/    111000,   480,    482,    523,    525,    272,    274,    284,    286,    },
	{/*"640x480_70.00"*/    28560,  640,    664,    728,    816,    480,    481,    484,    500,    },
	{/*"640x640_60.00"*/	33100,	640,	672,	736,	832,	640,	641,	644,	663,	},
	{/*"640x768_60.00"*/	39690,	640,	672,	736,	832,	768,	769,	772,	795,	},
	{/*"640x800_60.00"*/	42130,	640,	680,	744,	848,	800,	801,	804,	828,	},
	{/*"800x480_70.00"*/    35840,  800,    832,    912,    1024,   480,    481,    484,    500,    },
	{/*"800x600_60.00"*/	38220,	800,	832,	912,	1024,	600,	601,	604,	622,	},
	{/*"800x640_60.00"*/	40730,	800,	832,	912,	1024,	640,	641,	644,	663,	},
	{/*"832x600_60.00"*/	40010,	832,	864,	952,	1072,	600,	601,	604,	622,	},
	{/*"832x608_60.00"*/	40520,	832,	864,	952,	1072,	608,	609,	612,	630,	},
	{/*"1024x480_60.00"*/	38170,	1024,	1048,	1152,	1280,	480,	481,	484,	497,	},
	{/*"1024x600_60.00"*/	48960,	1024,	1064,	1168,	1312,	600,	601,	604,	622,	},
	{/*"1024x640_60.00"*/	52830,	1024,	1072,	1176,	1328,	640,	641,	644,	663,	},
	{/*"1024x768_60.00"*/	64110,	1024,	1080,	1184,	1344,	768,	769,	772,	795,	},
	{/*"1152x764_60.00"*/   71380,  1152,   1208,   1328,   1504,   764,    765,    768,    791,    },
	{/*"1280x800_60.00"*/   83460,  1280,   1344,   1480,   1680,   800,    801,    804,    828,    },
	{/*"1280x1024_55.00"*/  98600,  1280,   1352,   1488,   1696,   1024,   1025,   1028,   1057,   },
	{/*"1440x800_60.00"*/   93800,  1440,   1512,   1664,   1888,   800,    801,    804,    828,    },
	{/*"1440x900_67.00"*/   120280, 1440,   1528,   1680,   1920,   900,    901,    904,    935,    },
};

ALIGN(16)
volatile rt_uint16_t _rt_framebuffer[FB_YSIZE][FB_XSIZE];
static struct rt_device_graphic_info _dc_info;

static void pwminit(void)
{
    pwm_info_t pwm_info;
    pwm_info.gpio = LS1C_PWM0_GPIO06;           // pwm引脚位gpio06
    pwm_info.mode = PWM_MODE_NORMAL;         // 正常模式--连续输出pwm波形
    pwm_info.duty = 0.85;                                   // pwm占空比 85%
    pwm_info.period_ns = 5*1000*1000;              // pwm周期5ms

	/*pwm初始化，初始化后立即产生pwm波形*/
	pwm_init(&pwm_info);

	/* 使能pwm */
	pwm_enable(&pwm_info);
}
int caclulate_freq(rt_uint32_t  XIN, rt_uint32_t PCLK)
{
	rt_uint32_t divider_int;
	rt_uint32_t needed_pixclk;
	rt_uint32_t  pll_clk, pix_div;
	rt_uint32_t  regval;


	pll_clk = PLL_FREQ; // 读CPU的 PLL及SDRAM 分频系数
	pll_clk =( pll_clk>>8 )& 0xff;
	pll_clk = XIN *  pll_clk / 4 ;
	pix_div = PLL_DIV_PARAM;//读CPU的 CPU/CAMERA/DC 分频系数
	pix_div = (pix_div>>24)&0xff;
	rt_kprintf("old pll_clk=%d, pix_div=%d\n", pll_clk, pix_div);

	divider_int = pll_clk/(1000000) *PCLK/1000; 
	if(divider_int%1000>=500)
		divider_int = divider_int/1000+1;
	else
		divider_int = divider_int/1000;
	rt_kprintf("divider_int = %d\n", divider_int);
	
	/* check whether divisor is too small. */
	if (divider_int < 1) {
		rt_kprintf("Warning: clock source is too slow.Try smaller resolution\n");
		divider_int = 1;
	}
	else if(divider_int > 100) {
		rt_kprintf("Warning: clock source is too fast.Try smaller resolution\n");
		divider_int = 100;
	}
	/* 配置分频寄存器 */
	{
		rt_uint32_t regval = 0;
		regval = PLL_DIV_PARAM;
		/*首先需要把分频使能位清零 */
		regval &= ~0x80000030;	//PIX_DIV_VALID  PIX_SEL  置0
		regval &= ~(0x3f<<24);	//PIX_DIV 清零
		regval |= divider_int << 24;
		PLL_DIV_PARAM = regval; 
		regval |= 0x80000030;	//PIX_DIV_VALID  PIX_SEL  置1
		PLL_DIV_PARAM = regval; 
	}
	rt_kprintf("new PLL_FREQ=0x%x, PLL_DIV_PARAM=0x%x\n", PLL_FREQ, PLL_DIV_PARAM);
	rt_thread_delay(10);
	return 0;
}

static rt_err_t rt_dc_init(rt_device_t dev)
{
	int i, out, mode=-1;
	int val;
	
	rt_kprintf("PWM initied\n");
	/* Set the back light PWM. */
	pwminit();
	
	for (i=0; i<sizeof(vga_mode)/sizeof(struct vga_struct); i++)
	{
		if (vga_mode[i].hr == FB_XSIZE && vga_mode[i].vr == FB_YSIZE)
		{
			mode=i;
			/* 计算时钟 配置频率*/
			caclulate_freq(OSC, vga_mode[i].pclk);
			break;
		}
	}

	if (mode<0)
	{
		rt_kprintf("\n\n\nunsupported framebuffer resolution\n\n\n");
		return;
	}

	DC_FB_CONFIG = 0x0;
	DC_FB_CONFIG = 0x3; //	// framebuffer configuration RGB565
 	DC_FB_BUFFER_ADDR0 = (rt_uint32_t)_rt_framebuffer - 0x80000000;
	DC_FB_BUFFER_ADDR1 = (rt_uint32_t)_rt_framebuffer - 0x80000000;
	DC_DITHER_CONFIG = 0x0;  //颜色抖动配置寄存器
	DC_DITHER_TABLE_LOW = 0x0; //颜色抖动查找表低位寄存器 
	DC_DITHER_TABLE_HIGH = 0x0; //颜色抖动查找表高位寄存器
	DC_PANEL_CONFIG = 0x80001311; //液晶面板配置寄存器
	DC_PANEL_TIMING = 0x0;

	DC_HDISPLAY = (vga_mode[mode].hfl<<16) | vga_mode[mode].hr;
	DC_HSYNC = 0x40000000 | (vga_mode[mode].hse<<16) | vga_mode[mode].hss;
	DC_VDISPLAY = (vga_mode[mode].vfl<<16) | vga_mode[mode].vr;
	DC_VSYNC = 0x40000000 | (vga_mode[mode].vse<<16) | vga_mode[mode].vss;

#if defined(CONFIG_VIDEO_32BPP)
	DC_FB_CONFIG = 0x00100105;
	DC_FB_BUFFER_STRIDE = FB_XSIZE*4;
#elif defined(CONFIG_VIDEO_24BPP)
	DC_FB_CONFIG = 0x00100104;
	DC_FB_BUFFER_STRIDE = (FB_XSIZE*4+255)&(~255);
#elif defined(CONFIG_VIDEO_16BPP)// 使用这个选项
	DC_FB_CONFIG = 0x00100103;
	DC_FB_BUFFER_STRIDE = (FB_XSIZE*2+255)&(~255);
#elif defined(CONFIG_VIDEO_15BPP)
	DC_FB_CONFIG = 0x00100102;
	DC_FB_BUFFER_STRIDE =  (FB_XSIZE*2+255)&(~255);
#elif defined(CONFIG_VIDEO_12BPP)
	DC_FB_CONFIG = 0x00100101;
	DC_FB_BUFFER_STRIDE =  (FB_XSIZE*2+255)&(~255);
#else  
	DC_FB_CONFIG = 0x00100104;
	DC_FB_BUFFER_STRIDE = (FB_XSIZE*4+255)&(~255);
#endif 
	return RT_EOK;
}

static rt_err_t rt_dc_control(rt_device_t dev, int cmd, void *args)
{
	switch (cmd)
	{
	case RTGRAPHIC_CTRL_RECT_UPDATE:
		break;
	case RTGRAPHIC_CTRL_POWERON:
		break;
	case RTGRAPHIC_CTRL_POWEROFF:
		break;
	case RTGRAPHIC_CTRL_GET_INFO:		
		rt_memcpy(args, &_dc_info, sizeof(_dc_info));
		break;
	case RTGRAPHIC_CTRL_SET_MODE:
		break;
	}

	return RT_EOK;
}

void rt_hw_dc_init(void)
{
	rt_device_t dc = rt_malloc(sizeof(struct rt_device));
	if (dc == RT_NULL) 
	{
		rt_kprintf("dc == RT_NULL\n");
		return; /* no memory yet */
	}

	_dc_info.bits_per_pixel = 16;
	_dc_info.pixel_format = RTGRAPHIC_PIXEL_FORMAT_RGB565P;
	_dc_info.framebuffer = (rt_uint8_t*)HW_FB_ADDR;
	_dc_info.width = FB_XSIZE;
	_dc_info.height = FB_YSIZE;

	/* init device structure */
	dc->type = RT_Device_Class_Graphic;
	dc->init = rt_dc_init;
	dc->open = RT_NULL;
	dc->close = RT_NULL;
	dc->control = rt_dc_control;
	dc->user_data = (void*)&_dc_info;
	
	/* register Display Controller device to RT-Thread */
	rt_device_register(dc, "dc", RT_DEVICE_FLAG_RDWR);
	
	rt_device_init(dc);
}