Hardware Aware
AI for System Software Engineering Teams

static int ais328dq_acc_hw_init(struct ais328dq_acc_data *acc){
int err = -1;
u8 buf[4]; printk(KERN_INFO "%s: hw init start\n", AIS328DQ_ACC_DEV_NAME); err = acc->tf->read(acc->dev, WHO_AM_I, 1, buf);
if (err < 0){
dev_warn(acc->dev, "Error reading WHO_AM_I: is device "
"available/working?\n");
goto err_firstread;
} else
acc->hw_working = 1;
if (buf[0] != WHOAMI_AIS328DQ_ACC) {
dev_err(acc->dev,
"device unknown. Expected: 0x%x,"
" Replies: 0x%x\n", WHOAMI_AIS328DQ_ACC, buf[0]);
err = -1; /* choose the right coded error */
goto err_unknown_device;
} buf[0] = acc->resume_state[RES_CTRL_REG1];
err = acc->tf->write(acc->dev, CTRL_REG1, 1, buf);
if (err < 0)
goto err_resume_state; buf[0] = acc->resume_state[RES_INT_THS1];
buf[1] = acc->resume_state[RES_INT_DUR1];
err = acc->tf->write(acc->dev, INT_THS1, 2, buf);
if (err < 0)
goto err_resume_state; buf[0] = acc->resume_state[RES_INT_CFG1];
err = acc->tf->write(acc->dev, INT_CFG1, 1, buf);
if (err < 0)
goto err_resume_state; buf[0] = acc->resume_state[RES_INT_THS2];
buf[1] = acc->resume_state[RES_INT_DUR2];
err = acc->tf->write(acc->dev, INT_THS2, 2, buf);
if (err < 0)
goto err_resume_state; buf[0] = acc->resume_state[RES_INT_CFG2];
err = acc->tf->write(acc->dev, INT_CFG2, 1, buf);
if (err < 0)
goto err_resume_state; buf[0] = acc->resume_state[RES_CTRL_REG2];
buf[1] = acc->resume_state[RES_CTRL_REG3];
buf[2] = acc->resume_state[RES_CTRL_REG4];
buf[3] = acc->resume_state[RES_CTRL_REG5];
err = acc->tf->write(acc->dev, CTRL_REG2, 4, buf);
if (err < 0)
goto err_resume_state; acc->hw_initialized = 1;
printk(KERN_INFO "%s: hw init done\n", AIS328DQ_ACC_DEV_NAME);
return 0;err_firstread:
acc->hw_working = 0;
err_unknown_device:
err_resume_state:
acc->hw_initialized = 0;
dev_err(acc->dev, "hw init error 0x%x,0x%x: %d\n", buf[0],
buf[1], err);
return err;
}