底层驱动开发

源代码在线查看: flexcop-sram.c

软件大小: 49318 K
上传用户: pj117
关键词: 底层 驱动开发
下载地址: 免注册下载 普通下载 VIP

相关代码

				/*				 * This file is part of linux driver the digital TV devices equipped with B2C2 FlexcopII(b)/III				 *				 * flexcop-sram.c - functions for controlling the SRAM.				 *				 * see flexcop.c for copyright information.				 */				#include "flexcop.h"								static void flexcop_sram_set_chip (struct flexcop_device *fc, flexcop_sram_type_t type)				{					flexcop_set_ibi_value(wan_ctrl_reg_71c,sram_chip,type);				}								int flexcop_sram_init(struct flexcop_device *fc)				{					switch (fc->rev) {						case FLEXCOP_II:						case FLEXCOP_IIB:							flexcop_sram_set_chip(fc,FC_SRAM_1_32KB);							break;						case FLEXCOP_III:							flexcop_sram_set_chip(fc,FC_SRAM_1_48KB);							break;						default:							return -EINVAL;					}					return 0;				}								int flexcop_sram_set_dest(struct flexcop_device *fc, flexcop_sram_dest_t dest, flexcop_sram_dest_target_t target)				{					flexcop_ibi_value v;									v = fc->read_ibi_reg(fc,sram_dest_reg_714);									if (fc->rev != FLEXCOP_III && target == FC_SRAM_DEST_TARGET_FC3_CA) {						err("SRAM destination target to available on FlexCopII(b)\n");						return -EINVAL;					}									deb_sram("sram dest: %x target: %x\n",dest, target);									if (dest & FC_SRAM_DEST_NET)						v.sram_dest_reg_714.NET_Dest = target;					if (dest & FC_SRAM_DEST_CAI)						v.sram_dest_reg_714.CAI_Dest = target;					if (dest & FC_SRAM_DEST_CAO)						v.sram_dest_reg_714.CAO_Dest = target;					if (dest & FC_SRAM_DEST_MEDIA)						v.sram_dest_reg_714.MEDIA_Dest = target;									fc->write_ibi_reg(fc,sram_dest_reg_714,v);					udelay(1000); /* TODO delay really necessary */									return 0;				}				EXPORT_SYMBOL(flexcop_sram_set_dest);								void flexcop_wan_set_speed(struct flexcop_device *fc, flexcop_wan_speed_t s)				{					flexcop_set_ibi_value(wan_ctrl_reg_71c,wan_speed_sig,s);				}				EXPORT_SYMBOL(flexcop_wan_set_speed);								void flexcop_sram_ctrl(struct flexcop_device *fc, int usb_wan, int sramdma, int maximumfill)				{					flexcop_ibi_value v = fc->read_ibi_reg(fc,sram_dest_reg_714);					v.sram_dest_reg_714.ctrl_usb_wan = usb_wan;					v.sram_dest_reg_714.ctrl_sramdma = sramdma;					v.sram_dest_reg_714.ctrl_maximumfill = maximumfill;					fc->write_ibi_reg(fc,sram_dest_reg_714,v);				}				EXPORT_SYMBOL(flexcop_sram_ctrl);								#if 0				static void flexcop_sram_write(struct adapter *adapter, u32 bank, u32 addr, u8 *buf, u32 len)				{					int i, retries;					u32 command;									for (i = 0; i < len; i++) {						command = bank | addr | 0x04000000 | (*buf 										retries = 2;										while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {							mdelay(1);							retries--;						};										if (retries == 0)							printk("%s: SRAM timeout\n", __FUNCTION__);										write_reg_dw(adapter, 0x700, command);										buf++;						addr++;					}				}								static void flex_sram_read(struct adapter *adapter, u32 bank, u32 addr, u8 *buf, u32 len)				{					int i, retries;					u32 command, value;									for (i = 0; i < len; i++) {						command = bank | addr | 0x04008000;										retries = 10000;										while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {							mdelay(1);							retries--;						};										if (retries == 0)							printk("%s: SRAM timeout\n", __FUNCTION__);										write_reg_dw(adapter, 0x700, command);										retries = 10000;										while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {							mdelay(1);							retries--;						};										if (retries == 0)							printk("%s: SRAM timeout\n", __FUNCTION__);										value = read_reg_dw(adapter, 0x700) >> 0x10;										*buf = (value & 0xff);										addr++;						buf++;					}				}								static void sram_write_chunk(struct adapter *adapter, u32 addr, u8 *buf, u16 len)				{					u32 bank;									bank = 0;									if (adapter->dw_sram_type == 0x20000) {						bank = (addr & 0x18000) 					}									if (adapter->dw_sram_type == 0x00000) {						if ((addr >> 0x0f) == 0)							bank = 0x20000000;						else							bank = 0x10000000;					}									flex_sram_write(adapter, bank, addr & 0x7fff, buf, len);				}								static void sram_read_chunk(struct adapter *adapter, u32 addr, u8 *buf, u16 len)				{					u32 bank;									bank = 0;									if (adapter->dw_sram_type == 0x20000) {						bank = (addr & 0x18000) 					}									if (adapter->dw_sram_type == 0x00000) {						if ((addr >> 0x0f) == 0)							bank = 0x20000000;						else							bank = 0x10000000;					}									flex_sram_read(adapter, bank, addr & 0x7fff, buf, len);				}								static void sram_read(struct adapter *adapter, u32 addr, u8 *buf, u32 len)				{					u32 length;									while (len != 0) {						length = len;										// check if the address range belongs to the same						// 32K memory chip. If not, the data is read from						// one chip at a time.						if ((addr >> 0x0f) != ((addr + len - 1) >> 0x0f)) {							length = (((addr >> 0x0f) + 1) 						}										sram_read_chunk(adapter, addr, buf, length);										addr = addr + length;						buf = buf + length;						len = len - length;					}				}								static void sram_write(struct adapter *adapter, u32 addr, u8 *buf, u32 len)				{					u32 length;									while (len != 0) {						length = len;										// check if the address range belongs to the same						// 32K memory chip. If not, the data is written to						// one chip at a time.						if ((addr >> 0x0f) != ((addr + len - 1) >> 0x0f)) {							length = (((addr >> 0x0f) + 1) 						}										sram_write_chunk(adapter, addr, buf, length);										addr = addr + length;						buf = buf + length;						len = len - length;					}				}								static void sram_set_size(struct adapter *adapter, u32 mask)				{					write_reg_dw(adapter, 0x71c, (mask | (~0x30000 & read_reg_dw(adapter, 0x71c))));				}								static void sram_init(struct adapter *adapter)				{					u32 tmp;									tmp = read_reg_dw(adapter, 0x71c);									write_reg_dw(adapter, 0x71c, 1);									if (read_reg_dw(adapter, 0x71c) != 0) {						write_reg_dw(adapter, 0x71c, tmp);										adapter->dw_sram_type = tmp & 0x30000;										ddprintk("%s: dw_sram_type = %x\n", __FUNCTION__, adapter->dw_sram_type);									} else {										adapter->dw_sram_type = 0x10000;										ddprintk("%s: dw_sram_type = %x\n", __FUNCTION__, adapter->dw_sram_type);					}									/* return value is never used? */				/*	return adapter->dw_sram_type; */				}								static int sram_test_location(struct adapter *adapter, u32 mask, u32 addr)				{					u8 tmp1, tmp2;									dprintk("%s: mask = %x, addr = %x\n", __FUNCTION__, mask, addr);									sram_set_size(adapter, mask);					sram_init(adapter);									tmp2 = 0xa5;					tmp1 = 0x4f;									sram_write(adapter, addr, &tmp2, 1);					sram_write(adapter, addr + 4, &tmp1, 1);									tmp2 = 0;									mdelay(20);									sram_read(adapter, addr, &tmp2, 1);					sram_read(adapter, addr, &tmp2, 1);									dprintk("%s: wrote 0xa5, read 0x%2x\n", __FUNCTION__, tmp2);									if (tmp2 != 0xa5)						return 0;									tmp2 = 0x5a;					tmp1 = 0xf4;									sram_write(adapter, addr, &tmp2, 1);					sram_write(adapter, addr + 4, &tmp1, 1);									tmp2 = 0;									mdelay(20);									sram_read(adapter, addr, &tmp2, 1);					sram_read(adapter, addr, &tmp2, 1);									dprintk("%s: wrote 0x5a, read 0x%2x\n", __FUNCTION__, tmp2);									if (tmp2 != 0x5a)						return 0;									return 1;				}								static u32 sram_length(struct adapter *adapter)				{					if (adapter->dw_sram_type == 0x10000)						return 32768;	//  32K					if (adapter->dw_sram_type == 0x00000)						return 65536;	//  64K					if (adapter->dw_sram_type == 0x20000)						return 131072;	// 128K									return 32768;		// 32K				}								/* FlexcopII can work with 32K, 64K or 128K of external SRAM memory.				    - for 128K there are 4x32K chips at bank 0,1,2,3.				    - for  64K there are 2x32K chips at bank 1,2.				    - for  32K there is one 32K chip at bank 0.								   FlexCop works only with one bank at a time. The bank is selected				   by bits 28-29 of the 0x700 register.								   bank 0 covers addresses 0x00000-0x07fff				   bank 1 covers addresses 0x08000-0x0ffff				   bank 2 covers addresses 0x10000-0x17fff				   bank 3 covers addresses 0x18000-0x1ffff				*/								static int flexcop_sram_detect(struct flexcop_device *fc)				{					flexcop_ibi_value r208,r71c_0,vr71c_1;									r208 = fc->read_ibi_reg(fc, ctrl_208);					fc->write_ibi_reg(fc, ctrl_208, ibi_zero);									r71c_0 = fc->read_ibi_reg(fc, wan_ctrl_reg_71c);									write_reg_dw(adapter, 0x71c, 1);									tmp3 = read_reg_dw(adapter, 0x71c);									dprintk("%s: tmp3 = %x\n", __FUNCTION__, tmp3);									write_reg_dw(adapter, 0x71c, tmp2);									// check for internal SRAM ???					tmp3--;					if (tmp3 != 0) {						sram_set_size(adapter, 0x10000);						sram_init(adapter);						write_reg_dw(adapter, 0x208, tmp);										dprintk("%s: sram size = 32K\n", __FUNCTION__);										return 32;					}									if (sram_test_location(adapter, 0x20000, 0x18000) != 0) {						sram_set_size(adapter, 0x20000);						sram_init(adapter);						write_reg_dw(adapter, 0x208, tmp);										dprintk("%s: sram size = 128K\n", __FUNCTION__);										return 128;					}									if (sram_test_location(adapter, 0x00000, 0x10000) != 0) {						sram_set_size(adapter, 0x00000);						sram_init(adapter);						write_reg_dw(adapter, 0x208, tmp);										dprintk("%s: sram size = 64K\n", __FUNCTION__);										return 64;					}									if (sram_test_location(adapter, 0x10000, 0x00000) != 0) {						sram_set_size(adapter, 0x10000);						sram_init(adapter);						write_reg_dw(adapter, 0x208, tmp);										dprintk("%s: sram size = 32K\n", __FUNCTION__);										return 32;					}									sram_set_size(adapter, 0x10000);					sram_init(adapter);					write_reg_dw(adapter, 0x208, tmp);									dprintk("%s: SRAM detection failed. Set to 32K \n", __FUNCTION__);									return 0;				}								static void sll_detect_sram_size(struct adapter *adapter)				{					sram_detect_for_flex2(adapter);				}								#endif							

相关资源