mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-08-20 18:17:07 +03:00
This is the bcm57xx package. I have tested default vlan functions, but I dont have the equipment to test more advanced setups. The default vlan setup seems to be working fine. I also added the activate_gpio parameter which will make the driver activate the switch via gpio before probing for it. I'm not sure which method is best for autoload. For the wrt350n, I need the activate_gpio parameter. But its probably not a good idea to add that to the autoload file. On a system without a bcm57xx switch, isn't it a bad idea to mess with the gpios looking for the switch? Ideally, wouldn't it be best to load the bcm57xx module from broadcom-diag, after it has determined which router its on? I tried using 'request_module' from there, but had no success. For now, I am relying on preinit to load the bcm57xx module with activate_gpio param, after it has failed to load switch_robo and switch_adm. Signed-off-by: Ben Pfountz <netprince (at) vt (dot) edu> git-svn-id: svn://svn.openwrt.org/openwrt/trunk@11471 3c298f89-4303-0410-b956-a3cf2f4a3e73
112 lines
4.2 KiB
C
112 lines
4.2 KiB
C
|
|
#if 1
|
|
#define DEBUG_REG printk
|
|
#else
|
|
#define DEBUG_REG
|
|
#endif
|
|
|
|
void ReadDataFromRegister(robo_info_t *robo, uint16 page_num,uint16 addr_num, uint16 len, void* data)
|
|
{
|
|
|
|
uint32 val32 = 0,val64[2];
|
|
uint16 val16 =0,val48[3];//,val32[2],val64[4];
|
|
memset(val48,0,6);
|
|
memset(val64,0,8);
|
|
//memset(val32,0,4);
|
|
DEBUG_REG("Read ioctl Page[0x%02x] Addr[0x%02x] len[%d].\n", page_num, addr_num, len);
|
|
switch (len)
|
|
{
|
|
case 1:
|
|
case 2:
|
|
{
|
|
robo->ops->read_reg(robo, page_num, addr_num, &val16, len);
|
|
DEBUG_REG("IRead 8/16 bit Page[0x%02x]addr[0x%02x]len[%d]val[0x%04x].\n",
|
|
page_num, addr_num, len, val16);
|
|
memcpy(data,&val16,2);
|
|
break;
|
|
}
|
|
case 4:
|
|
{
|
|
robo->ops->read_reg(robo, page_num, addr_num, &val32, len);
|
|
DEBUG_REG("IRead 32bit Page[0x%02x]addr[0x%02x]len[%d]val[0x%08x].\n",
|
|
page_num, addr_num, len, val32);
|
|
memcpy(data,&val32,4);
|
|
break;
|
|
}
|
|
case 6:
|
|
{
|
|
robo->ops->read_reg(robo, page_num,addr_num, &val48, len);
|
|
DEBUG_REG("IRead 48bit Page[0x%02x]addr[0x%02x]len[%d]val[0x%04x-0x%04x-0x%04x].\n",
|
|
page_num, addr_num, len, val48[0], val48[1], val48[2]);
|
|
memcpy(data,&val48,6);
|
|
break;
|
|
}
|
|
case 8:
|
|
{
|
|
robo->ops->read_reg(robo, page_num, addr_num, &val64, len);
|
|
DEBUG_REG("IRead 64bit Page[0x%02x]addr[0x%02x]len[%d]val[0x%08x-0x%08x].\n",
|
|
page_num, addr_num, len, val64[0], val64[1]);
|
|
memcpy(data,&val64,8);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void WriteDataToRegister(robo_info_t *robo,uint16 page_num,uint16 addr_num, uint16 len, void* data)
|
|
{
|
|
DEBUG_REG("Write ioctl Page[0x%02x]Addr[0x%02x]len[%d].\n",page_num,addr_num,len);
|
|
switch (len)
|
|
{
|
|
case 1:
|
|
case 2:
|
|
{
|
|
DEBUG_REG("Write 2byte Page[0x%02x]addr[0x%02x]len[%d]val[0x%04x].\n",
|
|
page_num, addr_num, len, *((uint16 *)data));
|
|
robo->ops->write_reg(robo, page_num, addr_num, data, len);
|
|
if (page_num < 0x10 || page_num > 0x17) {
|
|
robo->ops->read_reg(robo, page_num, addr_num, data, len);
|
|
DEBUG_REG("Reload Page[0x%02x]addr[0x%02x]len[%d]val[0x%04x].\n",
|
|
page_num, addr_num, len, *((uint16 *)data));
|
|
}
|
|
break;
|
|
}
|
|
case 4:
|
|
{
|
|
DEBUG_REG("Write 4byte Page[0x%02x]addr[0x%02x]len[%d]val[0x%08x].\n",
|
|
page_num, addr_num, len, *((uint32 *)data));
|
|
robo->ops->write_reg(robo, page_num, addr_num, data, len);
|
|
if (page_num < 0x10 || page_num > 0x17) {
|
|
robo->ops->read_reg(robo, page_num, addr_num, data, len);
|
|
DEBUG_REG("Reload Page[0x%02x]addr[0x%02x]len[%d]val[0x%08x].\n",
|
|
page_num, addr_num, len, *((uint32 *)data));
|
|
}
|
|
break;
|
|
}
|
|
case 6:
|
|
{
|
|
DEBUG_REG("Write 6byte Page[0x%02x]addr[0x%02x]len[%d]val[0x%04x-0x%04x-0x%04x].\n",
|
|
page_num, addr_num, len, *((uint16 *)data),*((((uint16 *)data)+1)),
|
|
*(((uint16 *)data)+2));
|
|
robo->ops->write_reg(robo, page_num, addr_num, data, len);
|
|
robo->ops->read_reg(robo, page_num, addr_num, data, len);
|
|
DEBUG_REG("Reload Page[0x%02x]addr[0x%02x]len[%d]val[0x%04x-0x%04x-0x%04x].\n",
|
|
page_num, addr_num, len,*((uint16 *)data),*((((uint16 *)data)+1)),
|
|
*(((uint16 *)data)+2));
|
|
break;
|
|
}
|
|
case 8:
|
|
{
|
|
DEBUG_REG("Write 8byte Page[0x%02x]addr[0x%02x]len[%d]val[0x%08x-0x%08x].\n",
|
|
page_num, addr_num, len, *((uint32*)data),*(((uint32 *)data)+1));
|
|
robo->ops->write_reg(robo, page_num, addr_num, data, len);
|
|
robo->ops->read_reg(robo, page_num, addr_num, data, len);
|
|
DEBUG_REG("Reload Page[0x%x]addr[0x%x]len[%d]val[0x%08x-0x%08x].\n",
|
|
page_num, addr_num, len,*((uint32 *)data), *(((uint32 *)data)+1));
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|