From: Stefan Ringel <stefan.ringel@arcor.de>
Date: Fri, 2 Apr 2010 16:52:49 +0000 (-0300)
Subject: V4L/DVB: tm6000: request labeling board version check
X-Git-Tag: MMI-PSA29.97-13-9~23880^2~176
X-Git-Url: https://git.stricted.de/?a=commitdiff_plain;h=2f7908848642c177b16b71a2ed52b57d614637ef;p=GitHub%2FMotorolaMobilityLLC%2Fkernel-slsi.git

V4L/DVB: tm6000: request labeling board version check

request labeling board version check

Signed-off-by: Stefan Ringel <stefan.ringel@arcor.de>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
---

diff --git a/drivers/staging/tm6000/tm6000-cards.c b/drivers/staging/tm6000/tm6000-cards.c
index f5732f56e67b..fad0aef082b6 100644
--- a/drivers/staging/tm6000/tm6000-cards.c
+++ b/drivers/staging/tm6000/tm6000-cards.c
@@ -480,9 +480,9 @@ int tm6000_cards_setup(struct tm6000_core *dev)
 		}
 
 		if (!i) {
-			rc = tm6000_get_reg16(dev, 0x40, 0, 0);
+			rc = tm6000_get_reg32(dev, REQ_40_GET_VERSION, 0, 0);
 			if (rc >= 0)
-				printk(KERN_DEBUG "board=%d\n", rc);
+				printk(KERN_DEBUG "board=0x%08x\n", rc);
 		}
 	}
 
diff --git a/drivers/staging/tm6000/tm6000-core.c b/drivers/staging/tm6000/tm6000-core.c
index d9cade00bc99..0b4dc6491ab3 100644
--- a/drivers/staging/tm6000/tm6000-core.c
+++ b/drivers/staging/tm6000/tm6000-core.c
@@ -139,6 +139,20 @@ int tm6000_get_reg16 (struct tm6000_core *dev, u8 req, u16 value, u16 index)
 	return buf[1]|buf[0]<<8;
 }
 
+int tm6000_get_reg32 (struct tm6000_core *dev, u8 req, u16 value, u16 index)
+{
+	int rc;
+	u8 buf[4];
+
+	rc=tm6000_read_write_usb (dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
+				       value, index, buf, 4);
+
+	if (rc<0)
+		return rc;
+
+	return buf[3] | buf[2] << 8 | buf[1] << 16 | buf[0] << 24;
+}
+
 void tm6000_set_fourcc_format(struct tm6000_core *dev)
 {
 	if (dev->dev_type == TM6010) {
@@ -455,9 +469,9 @@ int tm6000_init (struct tm6000_core *dev)
 	msleep(5); /* Just to be conservative */
 
 	/* Check board version - maybe 10Moons specific */
-	board=tm6000_get_reg16 (dev, 0x40, 0, 0);
+	board=tm6000_get_reg32 (dev, REQ_40_GET_VERSION, 0, 0);
 	if (board >=0) {
-		printk (KERN_INFO "Board version = 0x%04x\n",board);
+		printk (KERN_INFO "Board version = 0x%08x\n",board);
 	} else {
 		printk (KERN_ERR "Error %i while retrieving board version\n",board);
 	}
diff --git a/drivers/staging/tm6000/tm6000.h b/drivers/staging/tm6000/tm6000.h
index 7fcc7478c69b..3d1cf46b53bb 100644
--- a/drivers/staging/tm6000/tm6000.h
+++ b/drivers/staging/tm6000/tm6000.h
@@ -225,6 +225,7 @@ int tm6000_read_write_usb (struct tm6000_core *dev, u8 reqtype, u8 req,
 			   u16 value, u16 index, u8 *buf, u16 len);
 int tm6000_get_reg (struct tm6000_core *dev, u8 req, u16 value, u16 index);
 int tm6000_get_reg16(struct tm6000_core *dev, u8 req, u16 value, u16 index);
+int tm6000_get_reg32(struct tm6000_core *dev, u8 req, u16 value, u16 index);
 int tm6000_set_reg (struct tm6000_core *dev, u8 req, u16 value, u16 index);
 int tm6000_init (struct tm6000_core *dev);