/*
* Initialization function
*/
static int mma7660_init_client(struct i2c_client *client)
{
int result;
mma7660_i2c_client = client;
if(0)
{
/*
* Probe the device. We try to set the device to Test Mode and then to
* write & verify XYZ registers
*/
result = i2c_smbus_write_byte_data(client, MMA7660_MODE,MK_MMA7660_MODE(0, 0, 0, 0, 0, 1, 0));
assert(result==0);
mdelay(MODE_CHANGE_DELAY_MS);
result = i2c_smbus_write_byte_data(client, MMA7660_XOUT, 0x2a);
assert(result==0);
result = i2c_smbus_write_byte_data(client, MMA7660_YOUT, 0x15);
assert(result==0);
result = i2c_smbus_write_byte_data(client, MMA7660_ZOUT, 0x3f);
assert(result==0);
result = i2c_smbus_read_byte_data(client, MMA7660_XOUT);
result= i2c_smbus_read_byte_data(client, MMA7660_YOUT);
result= i2c_smbus_read_byte_data(client, MMA7660_ZOUT);
assert(result=0x3f);
}
// Enable Orientation Detection Logic
result = i2c_smbus_write_byte_data(client,
MMA7660_MODE, MK_MMA7660_MODE(0, 0, 0, 0, 0, 0, 0)); //enter standby
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_SR, MK_MMA7660_SR(2, 2, 1));
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_INTSU, MK_MMA7660_INTSU(0, 0, 0, 0, 1, 0, 1, 1));
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_SPCNT, 0xA0);
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_MODE, MK_MMA7660_MODE(0, 1, 0, 0, 0, 0, 1));
assert(result==0);
mdelay(MODE_CHANGE_DELAY_MS);
return result;
}
static int mma7660_init_client(struct i2c_client *client)
{
int result;
mma7660_i2c_client = client;
//plat_data = (struct mxc_mma7660_platform_data *)client->dev.platform_data;
//assert(plat_data);
if(0)
{
/*
* Probe the device. We try to set the device to Test Mode and then to
* write & verify XYZ registers
*/
result = i2c_smbus_write_byte_data(client, MMA7660_MODE,MK_MMA7660_MODE(0, 0, 0, 0, 0, 1, 0));
assert(result==0);
mdelay(MODE_CHANGE_DELAY_MS);
result = i2c_smbus_write_byte_data(client, MMA7660_XOUT, 0x2a);
assert(result==0);
result = i2c_smbus_write_byte_data(client, MMA7660_YOUT, 0x15);
assert(result==0);
result = i2c_smbus_write_byte_data(client, MMA7660_ZOUT, 0x3f);
assert(result==0);
result = i2c_smbus_read_byte_data(client, MMA7660_XOUT);
result= i2c_smbus_read_byte_data(client, MMA7660_YOUT);
result= i2c_smbus_read_byte_data(client, MMA7660_ZOUT);
assert(result=0x3f);
}
// Enable Orientation Detection Logic
result = i2c_smbus_write_byte_data(client,
MMA7660_MODE, MK_MMA7660_MODE(0, 0, 0, 0, 0, 0, 0)); //enter standby
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_SR, MK_MMA7660_SR(2, 2, 1));
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_INTSU, MK_MMA7660_INTSU(0, 0, 0, 0, 1, 0, 1, 1));
//if(result){
//printk("======================result =%d\n",result);}
//else{
//printk("***************************************result =%d\n",result);}
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_SPCNT, 0xA0);
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_MODE, MK_MMA7660_MODE(0, 1, 0, 0, 0, 0, 1));
assert(result==0);
// MMA7660's INT is connected to imx51 EVK's GPIO4_17
// We install interrupt handler here
/*assert(plat_data->irq);
result = request_irq(plat_data->irq, mmx7660_irq_handler,
IRQF_TRIGGER_FALLING , MMA7660_DRV_NAME, NULL);
assert(result==0);*/
mdelay(MODE_CHANGE_DELAY_MS);
{
u8 tilt;
mma7660_read_tilt(&tilt);
orientation = tilt&0x1f;
}
return result;
}