drivers/media/common/b2c2/flexcop-sram.c - nest-cam/v366/kernel_backports - Git at Google

 /*
  * Linux driver for 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 << 0x10);

 		retries = 2;

 		while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {
 			mdelay(1);
 			retries--;
 		}

 		if (retries == 0)
 			printk("%s: SRAM timeout\n", __func__);

 		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", __func__);

 		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", __func__);

 		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) << 0x0d;
 	}

 	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) << 0x0d;
 	}

 	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) << 0x0f) - addr;
 		}

 		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) << 0x0f) - addr;
 		}

 		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", __func__, adapter->dw_sram_type);
 	} else {
 		adapter->dw_sram_type = 0x10000;
 		ddprintk("%s: dw_sram_type = %x\n", __func__, 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", __func__, 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", __func__, 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", __func__, 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", __func__, 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", __func__);
 		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", __func__);
 		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", __func__);
 		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", __func__);
 		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", __func__);
 	return 0;
 }

 static void sll_detect_sram_size(struct adapter *adapter)
 {
 	sram_detect_for_flex2(adapter);
 }

 #endif
	/*
	* Linux driver for 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 << 0x10);

	retries = 2;

	while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {
	mdelay(1);
	retries--;
	}

	if (retries == 0)
	printk("%s: SRAM timeout\n", __func__);

	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", __func__);

	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", __func__);

	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) << 0x0d;
	}

	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) << 0x0d;
	}

	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) << 0x0f) - addr;
	}

	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) << 0x0f) - addr;
	}

	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", __func__, adapter->dw_sram_type);
	} else {
	adapter->dw_sram_type = 0x10000;
	ddprintk("%s: dw_sram_type = %x\n", __func__, 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", __func__, 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", __func__, 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", __func__, 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", __func__, 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", __func__);
	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", __func__);
	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", __func__);
	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", __func__);
	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", __func__);
	return 0;
	}

	static void sll_detect_sram_size(struct adapter *adapter)
	{
	sram_detect_for_flex2(adapter);
	}

	#endif