365 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * Linux driver for digital TV devices equipped with B2C2 FlexcopII(b)/III4 * flexcop-sram.c - functions for controlling the SRAM5 * see flexcop.c for copyright information6 */7#include "flexcop.h"8 9static void flexcop_sram_set_chip(struct flexcop_device *fc,10 flexcop_sram_type_t type)11{12 flexcop_set_ibi_value(wan_ctrl_reg_71c, sram_chip, type);13}14 15int flexcop_sram_init(struct flexcop_device *fc)16{17 switch (fc->rev) {18 case FLEXCOP_II:19 case FLEXCOP_IIB:20 flexcop_sram_set_chip(fc, FC_SRAM_1_32KB);21 break;22 case FLEXCOP_III:23 flexcop_sram_set_chip(fc, FC_SRAM_1_48KB);24 break;25 default:26 return -EINVAL;27 }28 return 0;29}30 31int flexcop_sram_set_dest(struct flexcop_device *fc, flexcop_sram_dest_t dest,32 flexcop_sram_dest_target_t target)33{34 flexcop_ibi_value v;35 v = fc->read_ibi_reg(fc, sram_dest_reg_714);36 37 if (fc->rev != FLEXCOP_III && target == FC_SRAM_DEST_TARGET_FC3_CA) {38 err("SRAM destination target to available on FlexCopII(b)\n");39 return -EINVAL;40 }41 deb_sram("sram dest: %x target: %x\n", dest, target);42 43 if (dest & FC_SRAM_DEST_NET)44 v.sram_dest_reg_714.NET_Dest = target;45 if (dest & FC_SRAM_DEST_CAI)46 v.sram_dest_reg_714.CAI_Dest = target;47 if (dest & FC_SRAM_DEST_CAO)48 v.sram_dest_reg_714.CAO_Dest = target;49 if (dest & FC_SRAM_DEST_MEDIA)50 v.sram_dest_reg_714.MEDIA_Dest = target;51 52 fc->write_ibi_reg(fc,sram_dest_reg_714,v);53 udelay(1000); /* TODO delay really necessary */54 55 return 0;56}57EXPORT_SYMBOL(flexcop_sram_set_dest);58 59void flexcop_wan_set_speed(struct flexcop_device *fc, flexcop_wan_speed_t s)60{61 flexcop_set_ibi_value(wan_ctrl_reg_71c,wan_speed_sig,s);62}63EXPORT_SYMBOL(flexcop_wan_set_speed);64 65void flexcop_sram_ctrl(struct flexcop_device *fc, int usb_wan, int sramdma, int maximumfill)66{67 flexcop_ibi_value v = fc->read_ibi_reg(fc,sram_dest_reg_714);68 v.sram_dest_reg_714.ctrl_usb_wan = usb_wan;69 v.sram_dest_reg_714.ctrl_sramdma = sramdma;70 v.sram_dest_reg_714.ctrl_maximumfill = maximumfill;71 fc->write_ibi_reg(fc,sram_dest_reg_714,v);72}73EXPORT_SYMBOL(flexcop_sram_ctrl);74 75#if 076static void flexcop_sram_write(struct adapter *adapter, u32 bank, u32 addr, u8 *buf, u32 len)77{78 int i, retries;79 u32 command;80 81 for (i = 0; i < len; i++) {82 command = bank | addr | 0x04000000 | (*buf << 0x10);83 84 retries = 2;85 86 while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {87 mdelay(1);88 retries--;89 }90 91 if (retries == 0)92 printk("%s: SRAM timeout\n", __func__);93 94 write_reg_dw(adapter, 0x700, command);95 96 buf++;97 addr++;98 }99}100 101static void flex_sram_read(struct adapter *adapter, u32 bank, u32 addr, u8 *buf, u32 len)102{103 int i, retries;104 u32 command, value;105 106 for (i = 0; i < len; i++) {107 command = bank | addr | 0x04008000;108 109 retries = 10000;110 111 while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {112 mdelay(1);113 retries--;114 }115 116 if (retries == 0)117 printk("%s: SRAM timeout\n", __func__);118 119 write_reg_dw(adapter, 0x700, command);120 121 retries = 10000;122 123 while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {124 mdelay(1);125 retries--;126 }127 128 if (retries == 0)129 printk("%s: SRAM timeout\n", __func__);130 131 value = read_reg_dw(adapter, 0x700) >> 0x10;132 133 *buf = (value & 0xff);134 135 addr++;136 buf++;137 }138}139 140static void sram_write_chunk(struct adapter *adapter, u32 addr, u8 *buf, u16 len)141{142 u32 bank;143 144 bank = 0;145 146 if (adapter->dw_sram_type == 0x20000) {147 bank = (addr & 0x18000) << 0x0d;148 }149 150 if (adapter->dw_sram_type == 0x00000) {151 if ((addr >> 0x0f) == 0)152 bank = 0x20000000;153 else154 bank = 0x10000000;155 }156 flex_sram_write(adapter, bank, addr & 0x7fff, buf, len);157}158 159static void sram_read_chunk(struct adapter *adapter, u32 addr, u8 *buf, u16 len)160{161 u32 bank;162 bank = 0;163 164 if (adapter->dw_sram_type == 0x20000) {165 bank = (addr & 0x18000) << 0x0d;166 }167 168 if (adapter->dw_sram_type == 0x00000) {169 if ((addr >> 0x0f) == 0)170 bank = 0x20000000;171 else172 bank = 0x10000000;173 }174 flex_sram_read(adapter, bank, addr & 0x7fff, buf, len);175}176 177static void sram_read(struct adapter *adapter, u32 addr, u8 *buf, u32 len)178{179 u32 length;180 while (len != 0) {181 length = len;182 /* check if the address range belongs to the same183 * 32K memory chip. If not, the data is read184 * from one chip at a time */185 if ((addr >> 0x0f) != ((addr + len - 1) >> 0x0f)) {186 length = (((addr >> 0x0f) + 1) << 0x0f) - addr;187 }188 189 sram_read_chunk(adapter, addr, buf, length);190 addr = addr + length;191 buf = buf + length;192 len = len - length;193 }194}195 196static void sram_write(struct adapter *adapter, u32 addr, u8 *buf, u32 len)197{198 u32 length;199 while (len != 0) {200 length = len;201 202 /* check if the address range belongs to the same203 * 32K memory chip. If not, the data is204 * written to one chip at a time */205 if ((addr >> 0x0f) != ((addr + len - 1) >> 0x0f)) {206 length = (((addr >> 0x0f) + 1) << 0x0f) - addr;207 }208 209 sram_write_chunk(adapter, addr, buf, length);210 addr = addr + length;211 buf = buf + length;212 len = len - length;213 }214}215 216static void sram_set_size(struct adapter *adapter, u32 mask)217{218 write_reg_dw(adapter, 0x71c,219 (mask | (~0x30000 & read_reg_dw(adapter, 0x71c))));220}221 222static void sram_init(struct adapter *adapter)223{224 u32 tmp;225 tmp = read_reg_dw(adapter, 0x71c);226 write_reg_dw(adapter, 0x71c, 1);227 228 if (read_reg_dw(adapter, 0x71c) != 0) {229 write_reg_dw(adapter, 0x71c, tmp);230 adapter->dw_sram_type = tmp & 0x30000;231 ddprintk("%s: dw_sram_type = %x\n", __func__, adapter->dw_sram_type);232 } else {233 adapter->dw_sram_type = 0x10000;234 ddprintk("%s: dw_sram_type = %x\n", __func__, adapter->dw_sram_type);235 }236}237 238static int sram_test_location(struct adapter *adapter, u32 mask, u32 addr)239{240 u8 tmp1, tmp2;241 dprintk("%s: mask = %x, addr = %x\n", __func__, mask, addr);242 243 sram_set_size(adapter, mask);244 sram_init(adapter);245 246 tmp2 = 0xa5;247 tmp1 = 0x4f;248 249 sram_write(adapter, addr, &tmp2, 1);250 sram_write(adapter, addr + 4, &tmp1, 1);251 252 tmp2 = 0;253 mdelay(20);254 255 sram_read(adapter, addr, &tmp2, 1);256 sram_read(adapter, addr, &tmp2, 1);257 258 dprintk("%s: wrote 0xa5, read 0x%2x\n", __func__, tmp2);259 260 if (tmp2 != 0xa5)261 return 0;262 263 tmp2 = 0x5a;264 tmp1 = 0xf4;265 266 sram_write(adapter, addr, &tmp2, 1);267 sram_write(adapter, addr + 4, &tmp1, 1);268 269 tmp2 = 0;270 mdelay(20);271 272 sram_read(adapter, addr, &tmp2, 1);273 sram_read(adapter, addr, &tmp2, 1);274 275 dprintk("%s: wrote 0x5a, read 0x%2x\n", __func__, tmp2);276 277 if (tmp2 != 0x5a)278 return 0;279 return 1;280}281 282static u32 sram_length(struct adapter *adapter)283{284 if (adapter->dw_sram_type == 0x10000)285 return 32768; /* 32K */286 if (adapter->dw_sram_type == 0x00000)287 return 65536; /* 64K */288 if (adapter->dw_sram_type == 0x20000)289 return 131072; /* 128K */290 return 32768; /* 32K */291}292 293/* FlexcopII can work with 32K, 64K or 128K of external SRAM memory.294 - for 128K there are 4x32K chips at bank 0,1,2,3.295 - for 64K there are 2x32K chips at bank 1,2.296 - for 32K there is one 32K chip at bank 0.297 298 FlexCop works only with one bank at a time. The bank is selected299 by bits 28-29 of the 0x700 register.300 301 bank 0 covers addresses 0x00000-0x07fff302 bank 1 covers addresses 0x08000-0x0ffff303 bank 2 covers addresses 0x10000-0x17fff304 bank 3 covers addresses 0x18000-0x1ffff */305 306static int flexcop_sram_detect(struct flexcop_device *fc)307{308 flexcop_ibi_value r208, r71c_0, vr71c_1;309 r208 = fc->read_ibi_reg(fc, ctrl_208);310 fc->write_ibi_reg(fc, ctrl_208, ibi_zero);311 312 r71c_0 = fc->read_ibi_reg(fc, wan_ctrl_reg_71c);313 write_reg_dw(adapter, 0x71c, 1);314 tmp3 = read_reg_dw(adapter, 0x71c);315 dprintk("%s: tmp3 = %x\n", __func__, tmp3);316 write_reg_dw(adapter, 0x71c, tmp2);317 318 // check for internal SRAM ???319 tmp3--;320 if (tmp3 != 0) {321 sram_set_size(adapter, 0x10000);322 sram_init(adapter);323 write_reg_dw(adapter, 0x208, tmp);324 dprintk("%s: sram size = 32K\n", __func__);325 return 32;326 }327 328 if (sram_test_location(adapter, 0x20000, 0x18000) != 0) {329 sram_set_size(adapter, 0x20000);330 sram_init(adapter);331 write_reg_dw(adapter, 0x208, tmp);332 dprintk("%s: sram size = 128K\n", __func__);333 return 128;334 }335 336 if (sram_test_location(adapter, 0x00000, 0x10000) != 0) {337 sram_set_size(adapter, 0x00000);338 sram_init(adapter);339 write_reg_dw(adapter, 0x208, tmp);340 dprintk("%s: sram size = 64K\n", __func__);341 return 64;342 }343 344 if (sram_test_location(adapter, 0x10000, 0x00000) != 0) {345 sram_set_size(adapter, 0x10000);346 sram_init(adapter);347 write_reg_dw(adapter, 0x208, tmp);348 dprintk("%s: sram size = 32K\n", __func__);349 return 32;350 }351 352 sram_set_size(adapter, 0x10000);353 sram_init(adapter);354 write_reg_dw(adapter, 0x208, tmp);355 dprintk("%s: SRAM detection failed. Set to 32K \n", __func__);356 return 0;357}358 359static void sll_detect_sram_size(struct adapter *adapter)360{361 sram_detect_for_flex2(adapter);362}363 364#endif365