|
@@ -19,8 +19,6 @@
|
|
#include <linux/matroxfb.h>
|
|
#include <linux/matroxfb.h>
|
|
#include <asm/div64.h>
|
|
#include <asm/div64.h>
|
|
|
|
|
|
-#define MAVEN_I2CID (0x1B)
|
|
|
|
-
|
|
|
|
#define MGATVO_B 1
|
|
#define MGATVO_B 1
|
|
#define MGATVO_C 2
|
|
#define MGATVO_C 2
|
|
|
|
|
|
@@ -128,7 +126,7 @@ static int get_ctrl_id(__u32 v4l2_id) {
|
|
|
|
|
|
struct maven_data {
|
|
struct maven_data {
|
|
struct matrox_fb_info* primary_head;
|
|
struct matrox_fb_info* primary_head;
|
|
- struct i2c_client client;
|
|
|
|
|
|
+ struct i2c_client *client;
|
|
int version;
|
|
int version;
|
|
};
|
|
};
|
|
|
|
|
|
@@ -974,7 +972,7 @@ static inline int maven_compute_timming(struct maven_data* md,
|
|
|
|
|
|
static int maven_program_timming(struct maven_data* md,
|
|
static int maven_program_timming(struct maven_data* md,
|
|
const struct mavenregs* m) {
|
|
const struct mavenregs* m) {
|
|
- struct i2c_client* c = &md->client;
|
|
|
|
|
|
+ struct i2c_client *c = md->client;
|
|
|
|
|
|
if (m->mode == MATROXFB_OUTPUT_MODE_MONITOR) {
|
|
if (m->mode == MATROXFB_OUTPUT_MODE_MONITOR) {
|
|
LR(0x80);
|
|
LR(0x80);
|
|
@@ -1011,7 +1009,7 @@ static int maven_program_timming(struct maven_data* md,
|
|
}
|
|
}
|
|
|
|
|
|
static inline int maven_resync(struct maven_data* md) {
|
|
static inline int maven_resync(struct maven_data* md) {
|
|
- struct i2c_client* c = &md->client;
|
|
|
|
|
|
+ struct i2c_client *c = md->client;
|
|
maven_set_reg(c, 0x95, 0x20); /* start whole thing */
|
|
maven_set_reg(c, 0x95, 0x20); /* start whole thing */
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
@@ -1069,48 +1067,48 @@ static int maven_set_control (struct maven_data* md,
|
|
maven_compute_bwlevel(md, &blacklevel, &whitelevel);
|
|
maven_compute_bwlevel(md, &blacklevel, &whitelevel);
|
|
blacklevel = (blacklevel >> 2) | ((blacklevel & 3) << 8);
|
|
blacklevel = (blacklevel >> 2) | ((blacklevel & 3) << 8);
|
|
whitelevel = (whitelevel >> 2) | ((whitelevel & 3) << 8);
|
|
whitelevel = (whitelevel >> 2) | ((whitelevel & 3) << 8);
|
|
- maven_set_reg_pair(&md->client, 0x0e, blacklevel);
|
|
|
|
- maven_set_reg_pair(&md->client, 0x1e, whitelevel);
|
|
|
|
|
|
+ maven_set_reg_pair(md->client, 0x0e, blacklevel);
|
|
|
|
+ maven_set_reg_pair(md->client, 0x1e, whitelevel);
|
|
}
|
|
}
|
|
break;
|
|
break;
|
|
case V4L2_CID_SATURATION:
|
|
case V4L2_CID_SATURATION:
|
|
{
|
|
{
|
|
- maven_set_reg(&md->client, 0x20, p->value);
|
|
|
|
- maven_set_reg(&md->client, 0x22, p->value);
|
|
|
|
|
|
+ maven_set_reg(md->client, 0x20, p->value);
|
|
|
|
+ maven_set_reg(md->client, 0x22, p->value);
|
|
}
|
|
}
|
|
break;
|
|
break;
|
|
case V4L2_CID_HUE:
|
|
case V4L2_CID_HUE:
|
|
{
|
|
{
|
|
- maven_set_reg(&md->client, 0x25, p->value);
|
|
|
|
|
|
+ maven_set_reg(md->client, 0x25, p->value);
|
|
}
|
|
}
|
|
break;
|
|
break;
|
|
case V4L2_CID_GAMMA:
|
|
case V4L2_CID_GAMMA:
|
|
{
|
|
{
|
|
const struct maven_gamma* g;
|
|
const struct maven_gamma* g;
|
|
g = maven_compute_gamma(md);
|
|
g = maven_compute_gamma(md);
|
|
- maven_set_reg(&md->client, 0x83, g->reg83);
|
|
|
|
- maven_set_reg(&md->client, 0x84, g->reg84);
|
|
|
|
- maven_set_reg(&md->client, 0x85, g->reg85);
|
|
|
|
- maven_set_reg(&md->client, 0x86, g->reg86);
|
|
|
|
- maven_set_reg(&md->client, 0x87, g->reg87);
|
|
|
|
- maven_set_reg(&md->client, 0x88, g->reg88);
|
|
|
|
- maven_set_reg(&md->client, 0x89, g->reg89);
|
|
|
|
- maven_set_reg(&md->client, 0x8a, g->reg8a);
|
|
|
|
- maven_set_reg(&md->client, 0x8b, g->reg8b);
|
|
|
|
|
|
+ maven_set_reg(md->client, 0x83, g->reg83);
|
|
|
|
+ maven_set_reg(md->client, 0x84, g->reg84);
|
|
|
|
+ maven_set_reg(md->client, 0x85, g->reg85);
|
|
|
|
+ maven_set_reg(md->client, 0x86, g->reg86);
|
|
|
|
+ maven_set_reg(md->client, 0x87, g->reg87);
|
|
|
|
+ maven_set_reg(md->client, 0x88, g->reg88);
|
|
|
|
+ maven_set_reg(md->client, 0x89, g->reg89);
|
|
|
|
+ maven_set_reg(md->client, 0x8a, g->reg8a);
|
|
|
|
+ maven_set_reg(md->client, 0x8b, g->reg8b);
|
|
}
|
|
}
|
|
break;
|
|
break;
|
|
case MATROXFB_CID_TESTOUT:
|
|
case MATROXFB_CID_TESTOUT:
|
|
{
|
|
{
|
|
unsigned char val
|
|
unsigned char val
|
|
- = maven_get_reg(&md->client,0x8d);
|
|
|
|
|
|
+ = maven_get_reg(md->client, 0x8d);
|
|
if (p->value) val |= 0x10;
|
|
if (p->value) val |= 0x10;
|
|
else val &= ~0x10;
|
|
else val &= ~0x10;
|
|
- maven_set_reg(&md->client, 0x8d, val);
|
|
|
|
|
|
+ maven_set_reg(md->client, 0x8d, val);
|
|
}
|
|
}
|
|
break;
|
|
break;
|
|
case MATROXFB_CID_DEFLICKER:
|
|
case MATROXFB_CID_DEFLICKER:
|
|
{
|
|
{
|
|
- maven_set_reg(&md->client, 0x93, maven_compute_deflicker(md));
|
|
|
|
|
|
+ maven_set_reg(md->client, 0x93, maven_compute_deflicker(md));
|
|
}
|
|
}
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
@@ -1189,6 +1187,7 @@ static int maven_init_client(struct i2c_client* clnt) {
|
|
MINFO_FROM(container_of(clnt->adapter, struct i2c_bit_adapter, adapter)->minfo);
|
|
MINFO_FROM(container_of(clnt->adapter, struct i2c_bit_adapter, adapter)->minfo);
|
|
|
|
|
|
md->primary_head = MINFO;
|
|
md->primary_head = MINFO;
|
|
|
|
+ md->client = clnt;
|
|
down_write(&ACCESS_FBINFO(altout.lock));
|
|
down_write(&ACCESS_FBINFO(altout.lock));
|
|
ACCESS_FBINFO(outputs[1]).output = &maven_altout;
|
|
ACCESS_FBINFO(outputs[1]).output = &maven_altout;
|
|
ACCESS_FBINFO(outputs[1]).src = ACCESS_FBINFO(outputs[1]).default_src;
|
|
ACCESS_FBINFO(outputs[1]).src = ACCESS_FBINFO(outputs[1]).default_src;
|
|
@@ -1232,14 +1231,11 @@ static int maven_shutdown_client(struct i2c_client* clnt) {
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
-static const unsigned short normal_i2c[] = { MAVEN_I2CID, I2C_CLIENT_END };
|
|
|
|
-I2C_CLIENT_INSMOD;
|
|
|
|
-
|
|
|
|
-static struct i2c_driver maven_driver;
|
|
|
|
-
|
|
|
|
-static int maven_detect_client(struct i2c_adapter* adapter, int address, int kind) {
|
|
|
|
- int err = 0;
|
|
|
|
- struct i2c_client* new_client;
|
|
|
|
|
|
+static int maven_probe(struct i2c_client *client,
|
|
|
|
+ const struct i2c_device_id *id)
|
|
|
|
+{
|
|
|
|
+ struct i2c_adapter *adapter = client->adapter;
|
|
|
|
+ int err = -ENODEV;
|
|
struct maven_data* data;
|
|
struct maven_data* data;
|
|
|
|
|
|
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WRITE_WORD_DATA |
|
|
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WRITE_WORD_DATA |
|
|
@@ -1250,50 +1246,37 @@ static int maven_detect_client(struct i2c_adapter* adapter, int address, int kin
|
|
err = -ENOMEM;
|
|
err = -ENOMEM;
|
|
goto ERROR0;
|
|
goto ERROR0;
|
|
}
|
|
}
|
|
- new_client = &data->client;
|
|
|
|
- i2c_set_clientdata(new_client, data);
|
|
|
|
- new_client->addr = address;
|
|
|
|
- new_client->adapter = adapter;
|
|
|
|
- new_client->driver = &maven_driver;
|
|
|
|
- new_client->flags = 0;
|
|
|
|
- strlcpy(new_client->name, "maven", I2C_NAME_SIZE);
|
|
|
|
- if ((err = i2c_attach_client(new_client)))
|
|
|
|
- goto ERROR3;
|
|
|
|
- err = maven_init_client(new_client);
|
|
|
|
|
|
+ i2c_set_clientdata(client, data);
|
|
|
|
+ err = maven_init_client(client);
|
|
if (err)
|
|
if (err)
|
|
goto ERROR4;
|
|
goto ERROR4;
|
|
return 0;
|
|
return 0;
|
|
ERROR4:;
|
|
ERROR4:;
|
|
- i2c_detach_client(new_client);
|
|
|
|
-ERROR3:;
|
|
|
|
kfree(data);
|
|
kfree(data);
|
|
ERROR0:;
|
|
ERROR0:;
|
|
return err;
|
|
return err;
|
|
}
|
|
}
|
|
|
|
|
|
-static int maven_attach_adapter(struct i2c_adapter* adapter) {
|
|
|
|
- if (adapter->id == I2C_HW_B_G400)
|
|
|
|
- return i2c_probe(adapter, &addr_data, &maven_detect_client);
|
|
|
|
- return 0;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-static int maven_detach_client(struct i2c_client* client) {
|
|
|
|
- int err;
|
|
|
|
-
|
|
|
|
- if ((err = i2c_detach_client(client)))
|
|
|
|
- return err;
|
|
|
|
|
|
+static int maven_remove(struct i2c_client *client)
|
|
|
|
+{
|
|
maven_shutdown_client(client);
|
|
maven_shutdown_client(client);
|
|
kfree(i2c_get_clientdata(client));
|
|
kfree(i2c_get_clientdata(client));
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static const struct i2c_device_id maven_id[] = {
|
|
|
|
+ { "maven", 0 },
|
|
|
|
+ { }
|
|
|
|
+};
|
|
|
|
+MODULE_DEVICE_TABLE(i2c, maven_id);
|
|
|
|
+
|
|
static struct i2c_driver maven_driver={
|
|
static struct i2c_driver maven_driver={
|
|
.driver = {
|
|
.driver = {
|
|
.name = "maven",
|
|
.name = "maven",
|
|
},
|
|
},
|
|
- .id = I2C_DRIVERID_MGATVO,
|
|
|
|
- .attach_adapter = maven_attach_adapter,
|
|
|
|
- .detach_client = maven_detach_client,
|
|
|
|
|
|
+ .probe = maven_probe,
|
|
|
|
+ .remove = maven_remove,
|
|
|
|
+ .id_table = maven_id,
|
|
};
|
|
};
|
|
|
|
|
|
static int __init matroxfb_maven_init(void)
|
|
static int __init matroxfb_maven_init(void)
|