/*----------------------------------------------------------------------------*/
static void st480_power(struct mag_hw *hw, unsigned int on)
{
static unsigned int power_on = 0;
if(hw->power_id != POWER_NONE_MACRO)
{
MSE_LOG("power %s\n", on ? "on" : "off");
if(power_on == on)
{
MSE_LOG("ignore power control: %d\n", on);
}
else if(on)
{
if(!hwPowerOn(hw->power_id, hw->power_vol, "st480"))
{
MSE_ERR("power on fails!!\n");
}
}
else
{
if(!hwPowerDown(hw->power_id, "st480"))
{
MSE_ERR("power off fail!!\n");
}
}
}
power_on = on;
}
static int yas_device_write(int32_t type, uint8_t addr, const uint8_t *buf,
int len)
{
uint8_t tmp[2];
int ret = 0;
struct yas_state *st = i2c_get_clientdata(this_client);
if (sizeof(tmp) - 1 < len)
return -1;
tmp[0] = addr;
memcpy(&tmp[1], buf, len);
mutex_lock(&yas537_i2c_mutex);
if((len+1) <= 8)
{
ret = i2c_master_send(this_client, tmp, len+1);
}
else
{
#if 0
if(unlikely(NULL == st->dma_va))
{
this_client->ext_flag &= I2C_MASK_FLAG; //CLEAR DMA FLAG
for(i=0; i<=(len+1); i=i+8)
{
trans_len = ((i+8)<=(len+1)) ? 8 : (len+1-i);
MSE_LOG("%s trans_len = %d\n", __FUNCTION__,trans_len);
ret = i2c_master_send(this_client, &tmp[i], trans_len);
if(ret < 0)
break;
}
}
else
#endif
{
this_client->ext_flag = this_client->ext_flag | I2C_DMA_FLAG; //ENABLE DMA FLAG
memset(st->dma_va, 0, 1024);
st->dma_va[0] = addr;
memcpy(&(st->dma_va[1]), buf, len);
ret = i2c_master_send(this_client, (char *)(st->dma_pa), len+1);
if(ret < 0)
{
MAGN_ERR("%s i2c_master_send failed! ret = %d\n",__FUNCTION__, ret);
}
}
}
this_client->ext_flag &= I2C_MASK_FLAG; //CLEAR DMA FLAG
mutex_unlock(&yas537_i2c_mutex);
if(ret < 0)
return ret;
//MSE_LOG("%s successful\n", __FUNCTION__);
return 0;
}
static int yas_device_read(int32_t type, uint8_t addr, uint8_t *buf, int len)
{
struct mt_i2c_msg msg[2];
int err = 0;
struct yas_state *st= i2c_get_clientdata(this_client);
//memset(msg, 0, sizeof(msg));
msg[0].addr = this_client->addr;
msg[0].flags = 0;
msg[0].len = 1;
msg[0].buf = &addr;
msg[0].timing = this_client->timing; //add for mtk i2c
msg[0].ext_flag = this_client->ext_flag & I2C_MASK_FLAG;//add for mtk i2c
msg[1].addr = this_client->addr;
msg[1].flags = I2C_M_RD;
msg[1].len = len;
msg[1].buf = buf;
msg[1].timing = this_client->timing; //add for mtk i2c
msg[1].ext_flag = this_client->ext_flag & I2C_MASK_FLAG;//add for mtk i2c
if((len > 8 ) && (st->dma_va != NULL))
{
msg[1].ext_flag = this_client->ext_flag | I2C_DMA_FLAG;//add for mtk i2c
}
mutex_lock(&yas537_i2c_mutex);
//#if 0
if(len <= 8)
{
err = i2c_transfer(this_client->adapter, (struct i2c_msg *)msg, 2);
if (err != 2) {
dev_err(&this_client->dev,
"i2c_transfer() read error: "
"adapter num = %d,slave_addr=%02x, reg_addr=%02x, err=%d\n",
this_client->adapter->nr, this_client->addr, addr, err);
mutex_unlock(&yas537_i2c_mutex);
return err;
}
}
//#else
else
{
#if 0
if(unlikely(NULL == st->dma_va))
{
this_client->ext_flag &= I2C_MASK_FLAG; //CLEAR DMA FLAG
memset(buf, 0,len);
buf = &addr;
err = i2c_master_send(this_client, buf,1);
if(err < 0)
{
MSE_ERR("%s i2c_master_send failed err = %d\n", __FUNCTION__, err);
mutex_unlock(&yas537_i2c_mutex);
return err;
}
for(i=0; i<=len; i=i+8)
{
trans_len = ((i+8)<=len) ? 8 : (len-i);
MSE_LOG("%s trans_len = %d\n", __FUNCTION__,trans_len);
err = i2c_master_recv(this_client, &buf[i], trans_len);
if(err < 0)
{
MSE_ERR("%s i2c_master_recv failed err = %d\n", __FUNCTION__, err);
mutex_unlock(&yas537_i2c_mutex);
return err;
}
}
}
else
#endif
{
memset(st->dma_va, 0, 1024);
msg[1].buf = (char *)(st->dma_pa);
err = i2c_transfer(this_client->adapter, (struct i2c_msg *)msg, 2);
if (err != 2) {
dev_err(&this_client->dev,
"i2c_transfer() read error: "
"adapter num = %d,slave_addr=%02x, reg_addr=%02x, err=%d\n",
this_client->adapter->nr, this_client->addr, addr, err);
mutex_unlock(&yas537_i2c_mutex);
return err;
}
memcpy(buf, st->dma_va, len);
}
}
//#endif
// MSE_LOG("%s successful\n", __FUNCTION__);
mutex_unlock(&yas537_i2c_mutex);
return 0;
}
