Ejemplo n.º 1
0
static int pm8xxx_vib_set_on(struct pm8xxx_vib_pwm *vib)
{
	int rc = 0;

	VIB_PWM_INFO("%s \n",__func__);


		if (switch_state == 0){
			VIB_PWM_INFO("%s vibrator is disable by switch\n",__func__);
			return 0;
		}
		rc = pwm_config(vib->pwm_vib, duty_us, period_us);
		if (rc < 0) {
			VIB_PWM_ERR("%s pwm config fail",__func__);
			return -EINVAL;
		}
		rc = pwm_enable(vib->pwm_vib);
		if (rc < 0) {
			VIB_PWM_ERR("%s pwm enable fail",__func__);
			return -EINVAL;
		}
		rc = gpio_direction_output(vib->ena_gpio, ENABLE_AMP);
		if (rc < 0) {
			VIB_PWM_ERR("%s enable amp fail",__func__);
			return -EINVAL;
		}
	return rc;
}
Ejemplo n.º 2
0
static enum hrtimer_restart pm8xxx_vib_timer_func(struct hrtimer *timer)
{
	int rc;
	struct pm8xxx_vib_pwm *vib = container_of(timer, struct pm8xxx_vib_pwm,
							 vib_timer);
	VIB_PWM_INFO("%s \n",__func__);
	rc = gpio_direction_output(vib->ena_gpio, DISABLE_AMP);
			if (rc < 0) {
				VIB_PWM_ERR("%s disable amp fail",__func__);
			}
	schedule_work(&vib->work);
	return HRTIMER_NORESTART;
}
Ejemplo n.º 3
0
static int pm8xxx_vib_set_off(struct pm8xxx_vib_pwm *vib)
{
	int rc = 0;
	VIB_PWM_INFO("%s \n",__func__);

		rc = pwm_config(vib->pwm_vib, period_us/2, period_us);
		if (rc < 0) {
			VIB_PWM_ERR("%s pwm config fail",__func__);
			return -EINVAL;
		}
		rc = pwm_enable(vib->pwm_vib);
		if (rc < 0) {
			VIB_PWM_ERR("%s pwm enable fail",__func__);
			return -EINVAL;
		}
		rc = gpio_direction_output(vib->ena_gpio, DISABLE_AMP);
		if (rc < 0) {
			VIB_PWM_ERR("%s disable amp fail",__func__);
			return -EINVAL;
		}
		pwm_disable(vib->pwm_vib);
	return rc;
}
Ejemplo n.º 4
0
static int __devinit pm8xxx_vib_probe(struct platform_device *pdev)

{
	const struct pm8xxx_vibrator_pwm_platform_data *pdata =
						pdev->dev.platform_data;
	struct pm8xxx_vib_pwm *vib;
	int rc;
	VIB_PWM_INFO("%s+\n", __func__);

	if (!pdata)
		return -EINVAL;
	if (pdata->duty_us > pdata->PERIOD_US  ||
			 pdata->duty_us < 0)
		return -EINVAL;
	vib = kzalloc(sizeof(*vib), GFP_KERNEL);
	if (!vib)
		return -ENOMEM;
	vib->pdata	= pdata;
	vib->vdd_gpio	= pdata->vdd_gpio;
	vib->ena_gpio	= pdata->ena_gpio;
	vib->dev	= &pdev->dev;
	spin_lock_init(&vib->lock);
	INIT_WORK(&vib->work, pm8xxx_vib_update);
	hrtimer_init(&vib->vib_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
	vib->vib_timer.function = pm8xxx_vib_timer_func;
	vib->timed_dev.name = "vibrator";
	vib->timed_dev.get_time = pm8xxx_vib_get_time;
	vib->timed_dev.enable = pm8xxx_vib_enable;
	vib->pwm_vib = pwm_request(vib->pdata->bank, vib->timed_dev.name);
	if (vib->pwm_vib < 0){
		rc = -ENOMEM;
		VIB_PWM_ERR("%s, pwm_request fail\n", __func__);
		goto err_pwm_request;
	}

	rc = gpio_request(vib->ena_gpio, "TI_AMP_ena");
	if (rc) {
		rc = -ENOMEM;
		VIB_PWM_ERR("%s, gpio_request ena fail\n", __func__);
		goto err_ena_gpio_request;
	}
	rc= gpio_request(vib->vdd_gpio, "TI_AMP_vdd");
	if(rc) {
		rc = -ENOMEM;
		VIB_PWM_ERR("%s, gpio_request vdd fail\n", __func__);
		goto err_vdd_gpio_request;
	}
	rc = timed_output_dev_register(&vib->timed_dev);
	if (rc < 0)
		goto err_read_vib;
	rc = device_create_file(vib->timed_dev.dev, &dev_attr_dutys);
	if (rc < 0) {
		VIB_PWM_ERR("%s, create duty sysfs fail: dutys\n", __func__);
	}
	rc = device_create_file(vib->timed_dev.dev, &dev_attr_function_switch);
	if (rc < 0) {
		VIB_PWM_ERR("%s, create duty sysfs fail: function_switch\n", __func__);
	}

	platform_set_drvdata(pdev, vib);
	duty_us= vib->pdata->duty_us;
	period_us=vib->pdata->PERIOD_US;
	VIB_PWM_INFO("%s-\n", __func__);
	return 0;
err_vdd_gpio_request:
	gpio_free(vib->vdd_gpio);
err_ena_gpio_request:
	gpio_free(vib->ena_gpio);
err_pwm_request:
	pwm_free(vib->pwm_vib);
err_read_vib:
	kfree(vib);
	return rc;
}