diff options
author | nbd <nbd@3c298f89-4303-0410-b956-a3cf2f4a3e73> | 2008-06-15 11:11:28 +0000 |
---|---|---|
committer | nbd <nbd@3c298f89-4303-0410-b956-a3cf2f4a3e73> | 2008-06-15 11:11:28 +0000 |
commit | 128434cb236523f4cec881622b8606cb1533b677 (patch) | |
tree | 628e1de7f62f279d851f47ad1ee6ab63c320c1c8 /package/broadcom-57xx/src/robo_register.c | |
parent | 27e96c3c29014c2bca2ec21d7c09d5839ee66cb5 (diff) |
(6/6) bcm57xx: package
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
Diffstat (limited to 'package/broadcom-57xx/src/robo_register.c')
-rw-r--r-- | package/broadcom-57xx/src/robo_register.c | 111 |
1 files changed, 111 insertions, 0 deletions
diff --git a/package/broadcom-57xx/src/robo_register.c b/package/broadcom-57xx/src/robo_register.c new file mode 100644 index 0000000000..acd385e0bf --- /dev/null +++ b/package/broadcom-57xx/src/robo_register.c @@ -0,0 +1,111 @@ + +#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; + } + } +} + |