static int yas_init(void) { uint8_t id = 0; if (module.initialized) return YAS_ERROR_INITIALIZE; module.cbk.usleep(YAS_POWERUP_TIME); if (module.cbk.device_open(YAS_TYPE_ACC) < 0) return YAS_ERROR_DEVICE_COMMUNICATION; if (yas_read_reg(YAS_WHO_AM_I, &id) < 0) { module.cbk.device_close(YAS_TYPE_ACC); return YAS_ERROR_DEVICE_COMMUNICATION; } printk("who_am_i_val:%02x\n", id); accel_product_id = id; if (id != YAS_WHO_AM_I_VAL) { module.cbk.device_close(YAS_TYPE_ACC); return YAS_ERROR_CHIP_ID; } module.enable = 0; module.delay = YAS_DEFAULT_SENSOR_DELAY; module.position = YAS_DEFAULT_POSITION; yas_set_odr(module.delay); yas_power_down(); module.cbk.device_close(YAS_TYPE_ACC); module.initialized = 1; return YAS_NO_ERROR; }
static int yas_set_delay(int delay) { if (!module.initialized) return YAS_ERROR_INITIALIZE; if (delay < 0) return YAS_ERROR_ARG; module.delay = delay; yas_set_odr(delay); if (!module.enable) return YAS_NO_ERROR; if (yas_write_reg(YAS_CTRL_REG1, module.odr | YAS_CTRL_XYZ_ENABLE) < 0) return YAS_ERROR_DEVICE_COMMUNICATION; module.cbk.usleep(module.turn_on_time); return YAS_NO_ERROR; }
static int yas_set_delay(int delay) { if (!module.initialized) return YAS_ERROR_INITIALIZE; if (delay < 0) return YAS_ERROR_ARG; module.delay = delay; yas_set_odr(delay); if (!module.enable) return YAS_NO_ERROR; if (yas_write_reg(YAS_CTRL_REG1, 0x00) < 0) return YAS_ERROR_DEVICE_COMMUNICATION; if (yas_write_reg(YAS_DATA_CTRL_REG, module.odr)) return YAS_ERROR_DEVICE_COMMUNICATION; if (yas_write_reg(YAS_CTRL_REG1 , YAS_CTRL_REG1_PC1 | YAS_CTRL_REG1_RES | YAS_CTRL_REG1_GSEL ) < 0) return YAS_ERROR_DEVICE_COMMUNICATION; module.cbk.usleep(module.startup_time); return YAS_NO_ERROR; }