Exemple #1
0
static int kxtf9_config(void *mlsl_handle,
			struct ext_slave_descr *slave,
			struct ext_slave_platform_data *pdata,
			struct ext_slave_config *data)
{
	struct kxtf9_private_data *private_data = pdata->private_data;
	if (!data->data)
		return INV_ERROR_INVALID_PARAMETER;

	switch (data->key) {
	case MPU_SLAVE_CONFIG_ODR_SUSPEND:
		return kxtf9_set_odr(mlsl_handle, pdata,
				     &private_data->suspend,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_ODR_RESUME:
		return kxtf9_set_odr(mlsl_handle, pdata,
				     &private_data->resume,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_FSR_SUSPEND:
		return kxtf9_set_fsr(mlsl_handle, pdata,
				     &private_data->suspend,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_FSR_RESUME:
		return kxtf9_set_fsr(mlsl_handle, pdata,
				     &private_data->resume,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_MOT_THS:
		return kxtf9_set_ths(mlsl_handle, pdata,
				     &private_data->suspend,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_NMOT_THS:
		return kxtf9_set_ths(mlsl_handle, pdata,
				     &private_data->resume,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_MOT_DUR:
		return kxtf9_set_dur(mlsl_handle, pdata,
				     &private_data->suspend,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_NMOT_DUR:
		return kxtf9_set_dur(mlsl_handle, pdata,
				     &private_data->resume,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_IRQ_SUSPEND:
		return kxtf9_set_irq(mlsl_handle, pdata,
				     &private_data->suspend,
				     data->apply, *((long *)data->data));
	case MPU_SLAVE_CONFIG_IRQ_RESUME:
		return kxtf9_set_irq(mlsl_handle, pdata,
				     &private_data->resume,
				     data->apply, *((long *)data->data));
	default:
		return INV_ERROR_FEATURE_NOT_IMPLEMENTED;
	};

	return INV_SUCCESS;
}
Exemple #2
0
static int kxtf9_init(void *mlsl_handle,
		struct ext_slave_descr *slave,
		struct ext_slave_platform_data *pdata)
{

	struct kxtf9_private_data *private_data;
	int result = ML_SUCCESS;

	private_data = (struct kxtf9_private_data *)
		MLOSMalloc(sizeof(struct kxtf9_private_data));

	if (!private_data)
		return ML_ERROR_MEMORY_EXAUSTED;

	/* RAM reset */
	result = MLSLSerialWriteSingle(mlsl_handle, pdata->address,
				KXTF9_CTRL_REG1,
				0x40); /* Fastest Reset */
	ERROR_CHECK(result);
	result = MLSLSerialWriteSingle(mlsl_handle, pdata->address,
				KXTF9_DATA_CTRL_REG,
				0x36); /* Fastest Reset */
	ERROR_CHECK(result);
	result = MLSLSerialWriteSingle(mlsl_handle, pdata->address,
				KXTF9_CTRL_REG3, 0xcd); /* Reset */
	ERROR_CHECK(result);
	MLOSSleep(2);

	pdata->private_data = private_data;

	private_data->resume.ctrl_reg1 = 0xC0;
	private_data->suspend.ctrl_reg1 = 0x40;

	result = kxtf9_set_dur(mlsl_handle, pdata, &private_data->suspend,
			FALSE, 1000);
	ERROR_CHECK(result);
	result = kxtf9_set_dur(mlsl_handle, pdata, &private_data->resume,
			FALSE,  2540);
	ERROR_CHECK(result);

	result = kxtf9_set_odr(mlsl_handle, pdata, &private_data->suspend,
			FALSE, 50000);
	ERROR_CHECK(result);
	result = kxtf9_set_odr(mlsl_handle, pdata, &private_data->resume,
			FALSE, 200000);

	result = kxtf9_set_fsr(mlsl_handle, pdata, &private_data->suspend,
			FALSE, 2000);
	ERROR_CHECK(result);
	result = kxtf9_set_fsr(mlsl_handle, pdata, &private_data->resume,
			FALSE, 2000);
	ERROR_CHECK(result);

	result = kxtf9_set_ths(mlsl_handle, pdata, &private_data->suspend,
			FALSE, 80);
	ERROR_CHECK(result);
	result = kxtf9_set_ths(mlsl_handle, pdata, &private_data->resume,
			FALSE, 40);
	ERROR_CHECK(result);

	result = kxtf9_set_irq(mlsl_handle, pdata, &private_data->suspend,
			FALSE,
			MPU_SLAVE_IRQ_TYPE_NONE);
	ERROR_CHECK(result);
	result = kxtf9_set_irq(mlsl_handle, pdata, &private_data->resume,
			FALSE,
			MPU_SLAVE_IRQ_TYPE_NONE);
	ERROR_CHECK(result);
	return result;
}
Exemple #3
0
static int kxtf9_init(void *mlsl_handle,
		      struct ext_slave_descr *slave,
		      struct ext_slave_platform_data *pdata)
{

	struct kxtf9_private_data *private_data;
	int result = INV_SUCCESS;

#ifndef UMPL
	private_data = (struct kxtf9_private_data *)
	    kzalloc(sizeof(struct kxtf9_private_data), GFP_KERNEL);
#else
    private_data = &kxtf9_private_data_instance;
#endif

	if (!private_data)
		return INV_ERROR_MEMORY_EXAUSTED;

	/* RAM reset */
	/* Fastest Reset */
	result = inv_serial_single_write(mlsl_handle, pdata->address,
					 KXTF9_CTRL_REG1, 0x40);
	if (result) {
		
		return result;
	}
	/* Fastest Reset */
	result = inv_serial_single_write(mlsl_handle, pdata->address,
					 KXTF9_DATA_CTRL_REG, 0x36);
	if (result) {
		
		return result;
	}
	/* Reset */
	result = inv_serial_single_write(mlsl_handle, pdata->address,
					 KXTF9_CTRL_REG3, 0xcd);
	if (result) {
		
		return result;
	}
	msleep(2);

	pdata->private_data = private_data;

	private_data->resume.ctrl_reg1 = 0xC0;
	private_data->suspend.ctrl_reg1 = 0x40;

	result = kxtf9_set_dur(mlsl_handle, pdata, &private_data->suspend,
			       false, 1000);
	if (result) {
		
		return result;
	}
	result = kxtf9_set_dur(mlsl_handle, pdata, &private_data->resume,
			       false, 2540);
	if (result) {
		
		return result;
	}

	result = kxtf9_set_odr(mlsl_handle, pdata, &private_data->suspend,
			       false, 50000);
	if (result) {
		
		return result;
	}
	result = kxtf9_set_odr(mlsl_handle, pdata, &private_data->resume,
			       false, 200000);

	result = kxtf9_set_fsr(mlsl_handle, pdata, &private_data->suspend,
			       false, 2000);
	if (result) {
		
		return result;
	}
	result = kxtf9_set_fsr(mlsl_handle, pdata, &private_data->resume,
			       false, 2000);
	if (result) {
		
		return result;
	}

	result = kxtf9_set_ths(mlsl_handle, pdata, &private_data->suspend,
			       false, 80);
	if (result) {
		
		return result;
	}
	result = kxtf9_set_ths(mlsl_handle, pdata, &private_data->resume,
			       false, 40);
	if (result) {
		
		return result;
	}

	result = kxtf9_set_irq(mlsl_handle, pdata, &private_data->suspend,
			       false, MPU_SLAVE_IRQ_TYPE_NONE);
	if (result) {
		
		return result;
	}
	result = kxtf9_set_irq(mlsl_handle, pdata, &private_data->resume,
			       false, MPU_SLAVE_IRQ_TYPE_NONE);
	if (result) {
		
		return result;
	}
	return result;
}