(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>

SVN-Revision: 11471

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;
+                }
+        }
+}
+