283 static int da7280_haptic_mem_update(struct da7280_haptic *haptics)  in da7280_haptic_mem_update()  argument
289 	error = regmap_read(haptics->regmap, DA7280_IRQ_STATUS1, &val);  in da7280_haptic_mem_update()
293 		dev_warn(haptics->dev,  in da7280_haptic_mem_update()
300 	error = regmap_read(haptics->regmap, DA7280_MEM_CTL2, &val);  in da7280_haptic_mem_update()
304 		dev_warn(haptics->dev, "Please unlock the bit first\n");  in da7280_haptic_mem_update()
309 	error = regmap_update_bits(haptics->regmap,  in da7280_haptic_mem_update()
316 	error = regmap_read(haptics->regmap, DA7280_MEM_CTL1, &val);  in da7280_haptic_mem_update()
320 	return regmap_bulk_write(haptics->regmap, val, haptics->snp_mem,  in da7280_haptic_mem_update()
324 static int da7280_haptic_set_pwm(struct da7280_haptic *haptics, bool enabled)  in da7280_haptic_set_pwm()  argument
330 	if (!haptics->gain && enabled) {  in da7280_haptic_set_pwm()
331 		dev_err(haptics->dev, "Unable to enable pwm with 0 gain\n");  in da7280_haptic_set_pwm()
335 	pwm_get_state(haptics->pwm_dev, &state);  in da7280_haptic_set_pwm()
338 		period_mag_multi = (u64)state.period * haptics->gain;  in da7280_haptic_set_pwm()
346 		if (!haptics->acc_en) {  in da7280_haptic_set_pwm()
354 	error = pwm_apply_might_sleep(haptics->pwm_dev, &state);  in da7280_haptic_set_pwm()
356 		dev_err(haptics->dev, "Failed to apply pwm state: %d\n", error);  in da7280_haptic_set_pwm()
361 static void da7280_haptic_activate(struct da7280_haptic *haptics)  in da7280_haptic_activate()  argument
365 	if (haptics->active)  in da7280_haptic_activate()
368 	switch (haptics->op_mode) {  in da7280_haptic_activate()
371 		if (haptics->acc_en && haptics->level > 0x7F)  in da7280_haptic_activate()
372 			haptics->level = 0x7F;  in da7280_haptic_activate()
373 		else if (haptics->level > 0xFF)  in da7280_haptic_activate()
374 			haptics->level = 0xFF;  in da7280_haptic_activate()
377 		error = regmap_write(haptics->regmap, DA7280_TOP_CTL2,  in da7280_haptic_activate()
378 				     haptics->level);  in da7280_haptic_activate()
380 			dev_err(haptics->dev,  in da7280_haptic_activate()
382 				haptics->level, error);  in da7280_haptic_activate()
388 		if (da7280_haptic_set_pwm(haptics, true))  in da7280_haptic_activate()
408 		dev_err(haptics->dev, "Invalid op mode %d\n", haptics->op_mode);  in da7280_haptic_activate()
412 	error = regmap_update_bits(haptics->regmap,  in da7280_haptic_activate()
415 				   haptics->op_mode);  in da7280_haptic_activate()
417 		dev_err(haptics->dev,  in da7280_haptic_activate()
422 	if (haptics->op_mode == DA7280_PWM_MODE ||  in da7280_haptic_activate()
423 	    haptics->op_mode == DA7280_RTWM_MODE) {  in da7280_haptic_activate()
424 		error = regmap_update_bits(haptics->regmap,  in da7280_haptic_activate()
429 			dev_err(haptics->dev,  in da7280_haptic_activate()
435 	haptics->active = true;  in da7280_haptic_activate()
438 static void da7280_haptic_deactivate(struct da7280_haptic *haptics)  in da7280_haptic_deactivate()  argument
442 	if (!haptics->active)  in da7280_haptic_deactivate()
446 	error = regmap_update_bits(haptics->regmap,  in da7280_haptic_deactivate()
450 		dev_err(haptics->dev,  in da7280_haptic_deactivate()
455 	switch (haptics->op_mode) {  in da7280_haptic_deactivate()
457 		error = regmap_write(haptics->regmap,  in da7280_haptic_deactivate()
460 			dev_err(haptics->dev,  in da7280_haptic_deactivate()
467 		if (da7280_haptic_set_pwm(haptics, false))  in da7280_haptic_deactivate()
473 		error = regmap_update_bits(haptics->regmap,  in da7280_haptic_deactivate()
477 			dev_err(haptics->dev,  in da7280_haptic_deactivate()
485 		dev_err(haptics->dev, "Invalid op mode %d\n", haptics->op_mode);  in da7280_haptic_deactivate()
489 	haptics->active = false;  in da7280_haptic_deactivate()
494 	struct da7280_haptic *haptics =  in da7280_haptic_work()  local
496 	int val = haptics->val;  in da7280_haptic_work()
499 		da7280_haptic_activate(haptics);  in da7280_haptic_work()
501 		da7280_haptic_deactivate(haptics);  in da7280_haptic_work()
508 	struct da7280_haptic *haptics = input_get_drvdata(dev);  in da7280_haptics_upload_effect()  local
515 	if (haptics->active)  in da7280_haptics_upload_effect()
521 		haptics->op_mode = haptics->const_op_mode;  in da7280_haptics_upload_effect()
522 		if (haptics->op_mode == DA7280_DRO_MODE) {  in da7280_haptics_upload_effect()
524 			haptics->level = tmp / 0x7FFF;  in da7280_haptics_upload_effect()
528 		haptics->gain =	effect->u.constant.level <= 0 ?  in da7280_haptics_upload_effect()
535 			dev_err(haptics->dev,  in da7280_haptics_upload_effect()
555 			dev_err(haptics->dev, "Invalid waveform data size\n");  in da7280_haptics_upload_effect()
564 		memset(haptics->snp_mem, 0, DA7280_SNP_MEM_SIZE);  in da7280_haptics_upload_effect()
568 				dev_err(haptics->dev,  in da7280_haptics_upload_effect()
573 			haptics->snp_mem[i] = (u8)data[i];  in da7280_haptics_upload_effect()
576 		error = da7280_haptic_mem_update(haptics);  in da7280_haptics_upload_effect()
578 			dev_err(haptics->dev,  in da7280_haptics_upload_effect()
593 			dev_err(haptics->dev,  in da7280_haptics_upload_effect()
600 		haptics->ps_seq_id = data[DA7280_CUSTOM_SEQ_ID_IDX] & 0x0f;  in da7280_haptics_upload_effect()
601 		haptics->ps_seq_loop = data[DA7280_CUSTOM_SEQ_LOOP_IDX] & 0x0f;  in da7280_haptics_upload_effect()
602 		haptics->op_mode = haptics->periodic_op_mode;  in da7280_haptics_upload_effect()
604 		val = FIELD_PREP(DA7280_PS_SEQ_ID_MASK, haptics->ps_seq_id) |  in da7280_haptics_upload_effect()
606 				   haptics->ps_seq_loop);  in da7280_haptics_upload_effect()
607 		error = regmap_write(haptics->regmap, DA7280_SEQ_CTL2, val);  in da7280_haptics_upload_effect()
609 			dev_err(haptics->dev,  in da7280_haptics_upload_effect()
624 			dev_err(haptics->dev,  in da7280_haptics_upload_effect()
632 		haptics->gpi_ctl[num].seq_id =  in da7280_haptics_upload_effect()
634 		haptics->op_mode = haptics->periodic_op_mode;  in da7280_haptics_upload_effect()
637 				 haptics->gpi_ctl[num].seq_id);  in da7280_haptics_upload_effect()
638 		error = regmap_update_bits(haptics->regmap,  in da7280_haptics_upload_effect()
643 			dev_err(haptics->dev,  in da7280_haptics_upload_effect()
650 		dev_err(haptics->dev, "Unsupported effect type: %d\n",  in da7280_haptics_upload_effect()
661 	struct da7280_haptic *haptics = input_get_drvdata(dev);  in da7280_haptics_playback()  local
663 	if (!haptics->op_mode) {  in da7280_haptics_playback()
664 		dev_warn(haptics->dev, "No effects have been uploaded\n");  in da7280_haptics_playback()
668 	if (likely(!haptics->suspended)) {  in da7280_haptics_playback()
669 		haptics->val = val;  in da7280_haptics_playback()
670 		schedule_work(&haptics->work);  in da7280_haptics_playback()
676 static int da7280_haptic_start(struct da7280_haptic *haptics)  in da7280_haptic_start()  argument
680 	error = regmap_update_bits(haptics->regmap,  in da7280_haptic_start()
685 		dev_err(haptics->dev, "Unable to enable device: %d\n", error);  in da7280_haptic_start()
692 static void da7280_haptic_stop(struct da7280_haptic *haptics)  in da7280_haptic_stop()  argument
696 	cancel_work_sync(&haptics->work);  in da7280_haptic_stop()
699 	da7280_haptic_deactivate(haptics);  in da7280_haptic_stop()
701 	error = regmap_update_bits(haptics->regmap, DA7280_TOP_CTL1,  in da7280_haptic_stop()
704 		dev_err(haptics->dev, "Failed to disable device: %d\n", error);  in da7280_haptic_stop()
709 	struct da7280_haptic *haptics = input_get_drvdata(dev);  in da7280_haptic_open()  local
711 	return da7280_haptic_start(haptics);  in da7280_haptic_open()
716 	struct da7280_haptic *haptics = input_get_drvdata(dev);  in da7280_haptic_close()  local
718 	da7280_haptic_stop(haptics);  in da7280_haptic_close()
772 				    struct da7280_haptic *haptics)  in da7280_parse_properties()  argument
785 	haptics->dev_type = DA7280_DEV_MAX;  in da7280_parse_properties()
788 		haptics->dev_type = da7280_haptic_of_mode_str(dev, str);  in da7280_parse_properties()
790 	haptics->const_op_mode = DA7280_DRO_MODE;  in da7280_parse_properties()
793 		haptics->const_op_mode = DA7280_PWM_MODE;  in da7280_parse_properties()
795 	haptics->periodic_op_mode = DA7280_RTWM_MODE;  in da7280_parse_properties()
798 		haptics->periodic_op_mode = DA7280_ETWM_MODE;  in da7280_parse_properties()
800 	haptics->nommax = DA7280_SKIP_INIT;  in da7280_parse_properties()
803 		haptics->nommax = da7280_haptic_of_volt_rating_set(val);  in da7280_parse_properties()
805 	haptics->absmax = DA7280_SKIP_INIT;  in da7280_parse_properties()
808 		haptics->absmax = da7280_haptic_of_volt_rating_set(val);  in da7280_parse_properties()
810 	haptics->imax = DA7280_IMAX_DEFAULT;  in da7280_parse_properties()
813 		haptics->imax = (val - 28600) / DA7280_IMAX_STEP + 1;  in da7280_parse_properties()
815 	haptics->impd = DA7280_IMPD_DEFAULT;  in da7280_parse_properties()
818 		haptics->impd = val;  in da7280_parse_properties()
820 	haptics->resonant_freq_h = DA7280_SKIP_INIT;  in da7280_parse_properties()
821 	haptics->resonant_freq_l = DA7280_SKIP_INIT;  in da7280_parse_properties()
826 			haptics->resonant_freq_h =  in da7280_parse_properties()
828 			haptics->resonant_freq_l =  in da7280_parse_properties()
831 			haptics->resonant_freq_h = DA7280_RESONT_FREQH_DFT;  in da7280_parse_properties()
832 			haptics->resonant_freq_l = DA7280_RESONT_FREQL_DFT;  in da7280_parse_properties()
837 	haptics->ps_seq_id = 0;  in da7280_parse_properties()
840 		haptics->ps_seq_id = val;  in da7280_parse_properties()
842 	haptics->ps_seq_loop = 0;  in da7280_parse_properties()
845 		haptics->ps_seq_loop = val;  in da7280_parse_properties()
850 		haptics->gpi_ctl[i].seq_id = DA7280_GPI_SEQ_ID_DFT + i;  in da7280_parse_properties()
853 			haptics->gpi_ctl[i].seq_id = val;  in da7280_parse_properties()
856 		haptics->gpi_ctl[i].mode = 0;  in da7280_parse_properties()
859 			haptics->gpi_ctl[i].mode =  in da7280_parse_properties()
863 		haptics->gpi_ctl[i].polarity = 0;  in da7280_parse_properties()
866 			haptics->gpi_ctl[i].polarity =  in da7280_parse_properties()
870 	haptics->bemf_sense_en =  in da7280_parse_properties()
872 	haptics->freq_track_en =  in da7280_parse_properties()
874 	haptics->acc_en =  in da7280_parse_properties()
876 	haptics->rapid_stop_en =  in da7280_parse_properties()
878 	haptics->amp_pid_en =  in da7280_parse_properties()
881 	haptics->mem_update = false;  in da7280_parse_properties()
885 		haptics->mem_update = true;  in da7280_parse_properties()
886 		memset(haptics->snp_mem, 0, DA7280_SNP_MEM_SIZE);  in da7280_parse_properties()
889 				haptics->snp_mem[i] = (u8)mem[i];  in da7280_parse_properties()
891 				dev_err(haptics->dev,  in da7280_parse_properties()
894 				haptics->mem_update = false;  in da7280_parse_properties()
903 	struct da7280_haptic *haptics = data;  in da7280_irq_handler()  local
904 	struct device *dev = haptics->dev;  in da7280_irq_handler()
909 	error = regmap_bulk_read(haptics->regmap, DA7280_IRQ_EVENT1,  in da7280_irq_handler()
917 	error = regmap_write(haptics->regmap, DA7280_IRQ_EVENT1, events[0]);  in da7280_irq_handler()
928 		error = regmap_update_bits(haptics->regmap, DA7280_TOP_CTL1,  in da7280_irq_handler()
936 		haptics->active = false;  in da7280_irq_handler()
961 static int da7280_init(struct da7280_haptic *haptics)  in da7280_init()  argument
972 	if (haptics->dev_type == DA7280_DEV_MAX) {  in da7280_init()
973 		error = regmap_read(haptics->regmap, DA7280_TOP_CFG1, &val);  in da7280_init()
977 		haptics->dev_type = val & DA7280_ACTUATOR_TYPE_MASK ?  in da7280_init()
982 	if (haptics->dev_type == DA7280_LRA &&  in da7280_init()
983 	    haptics->resonant_freq_l != DA7280_SKIP_INIT) {  in da7280_init()
984 		error = regmap_write(haptics->regmap, DA7280_FRQ_LRA_PER_H,  in da7280_init()
985 				     haptics->resonant_freq_h);  in da7280_init()
988 		error = regmap_write(haptics->regmap, DA7280_FRQ_LRA_PER_L,  in da7280_init()
989 				     haptics->resonant_freq_l);  in da7280_init()
992 	} else if (haptics->dev_type == DA7280_ERM_COIN) {  in da7280_init()
993 		error = regmap_update_bits(haptics->regmap, DA7280_TOP_INT_CFG1,  in da7280_init()
1002 		error = regmap_update_bits(haptics->regmap, DA7280_TOP_CFG4,  in da7280_init()
1007 		haptics->acc_en = false;  in da7280_init()
1008 		haptics->rapid_stop_en = false;  in da7280_init()
1009 		haptics->amp_pid_en = false;  in da7280_init()
1019 			 (haptics->dev_type ? 1 : 0)) |  in da7280_init()
1021 			   (haptics->bemf_sense_en ? 1 : 0)) |  in da7280_init()
1023 			   (haptics->freq_track_en ? 1 : 0)) |  in da7280_init()
1025 			   (haptics->acc_en ? 1 : 0)) |  in da7280_init()
1027 			   (haptics->rapid_stop_en ? 1 : 0)) |  in da7280_init()
1029 			   (haptics->amp_pid_en ? 1 : 0));  in da7280_init()
1031 	error = regmap_update_bits(haptics->regmap, DA7280_TOP_CFG1, mask, val);  in da7280_init()
1035 	error = regmap_update_bits(haptics->regmap, DA7280_TOP_CFG5,  in da7280_init()
1037 				   haptics->acc_en ?  in da7280_init()
1042 	error = regmap_update_bits(haptics->regmap,  in da7280_init()
1045 				   haptics->acc_en ?  in da7280_init()
1050 	if (haptics->nommax != DA7280_SKIP_INIT) {  in da7280_init()
1051 		error = regmap_write(haptics->regmap, DA7280_ACTUATOR1,  in da7280_init()
1052 				     haptics->nommax);  in da7280_init()
1057 	if (haptics->absmax != DA7280_SKIP_INIT) {  in da7280_init()
1058 		error = regmap_write(haptics->regmap, DA7280_ACTUATOR2,  in da7280_init()
1059 				     haptics->absmax);  in da7280_init()
1064 	error = regmap_update_bits(haptics->regmap, DA7280_ACTUATOR3,  in da7280_init()
1065 				   DA7280_IMAX_MASK, haptics->imax);  in da7280_init()
1069 	v2i_factor = haptics->impd * (haptics->imax + 4) / 1610400;  in da7280_init()
1070 	error = regmap_write(haptics->regmap, DA7280_CALIB_V2I_L,  in da7280_init()
1074 	error = regmap_write(haptics->regmap, DA7280_CALIB_V2I_H,  in da7280_init()
1079 	error = regmap_update_bits(haptics->regmap,  in da7280_init()
1086 	if (haptics->mem_update) {  in da7280_init()
1087 		error = da7280_haptic_mem_update(haptics);  in da7280_init()
1093 	val = FIELD_PREP(DA7280_PS_SEQ_ID_MASK, haptics->ps_seq_id) |  in da7280_init()
1094 		FIELD_PREP(DA7280_PS_SEQ_LOOP_MASK, haptics->ps_seq_loop);  in da7280_init()
1095 	error = regmap_write(haptics->regmap, DA7280_SEQ_CTL2, val);  in da7280_init()
1102 				 haptics->gpi_ctl[i].seq_id) |  in da7280_init()
1104 				   haptics->gpi_ctl[i].mode) |  in da7280_init()
1106 				   haptics->gpi_ctl[i].polarity);  in da7280_init()
1107 		error = regmap_write(haptics->regmap,  in da7280_init()
1114 	error = regmap_update_bits(haptics->regmap,  in da7280_init()
1122 	error = regmap_write(haptics->regmap, DA7280_IRQ_EVENT1, 0xff);  in da7280_init()
1126 	error = regmap_update_bits(haptics->regmap,  in da7280_init()
1134 	haptics->active = false;  in da7280_init()
1138 	dev_err(haptics->dev, "chip initialization error: %d\n", error);  in da7280_init()
1145 	struct da7280_haptic *haptics;  in da7280_probe()  local
1156 	haptics = devm_kzalloc(dev, sizeof(*haptics), GFP_KERNEL);  in da7280_probe()
1157 	if (!haptics)  in da7280_probe()
1160 	haptics->dev = dev;  in da7280_probe()
1162 	da7280_parse_properties(dev, haptics);  in da7280_probe()
1164 	if (haptics->const_op_mode == DA7280_PWM_MODE) {  in da7280_probe()
1165 		haptics->pwm_dev = devm_pwm_get(dev, NULL);  in da7280_probe()
1166 		error = PTR_ERR_OR_ZERO(haptics->pwm_dev);  in da7280_probe()
1175 		pwm_init_state(haptics->pwm_dev, &state);  in da7280_probe()
1177 		error = pwm_apply_might_sleep(haptics->pwm_dev, &state);  in da7280_probe()
1194 	INIT_WORK(&haptics->work, da7280_haptic_work);  in da7280_probe()
1196 	haptics->client = client;  in da7280_probe()
1197 	i2c_set_clientdata(client, haptics);  in da7280_probe()
1199 	haptics->regmap = devm_regmap_init_i2c(client,  in da7280_probe()
1201 	error = PTR_ERR_OR_ZERO(haptics->regmap);  in da7280_probe()
1207 	error = da7280_init(haptics);  in da7280_probe()
1224 	input_set_drvdata(input_dev, haptics);  in da7280_probe()
1225 	haptics->input_dev = input_dev;  in da7280_probe()
1227 	input_set_capability(haptics->input_dev, EV_FF, FF_PERIODIC);  in da7280_probe()
1228 	input_set_capability(haptics->input_dev, EV_FF, FF_CUSTOM);  in da7280_probe()
1229 	input_set_capability(haptics->input_dev, EV_FF, FF_CONSTANT);  in da7280_probe()
1230 	input_set_capability(haptics->input_dev, EV_FF, FF_GAIN);  in da7280_probe()
1232 	error = input_ff_create(haptics->input_dev,  in da7280_probe()
1252 					  "da7280-haptics", haptics);  in da7280_probe()
1264 	struct da7280_haptic *haptics = dev_get_drvdata(dev);  in da7280_suspend()  local
1266 	guard(mutex)(&haptics->input_dev->mutex);  in da7280_suspend()
1272 	scoped_guard(spinlock_irq, &haptics->input_dev->event_lock) {  in da7280_suspend()
1273 		haptics->suspended = true;  in da7280_suspend()
1276 	da7280_haptic_stop(haptics);  in da7280_suspend()
1283 	struct da7280_haptic *haptics = dev_get_drvdata(dev);  in da7280_resume()  local
1286 	guard(mutex)(&haptics->input_dev->mutex);  in da7280_resume()
1288 	error = da7280_haptic_start(haptics);  in da7280_resume()
1292 	scoped_guard(spinlock_irq, &haptics->input_dev->event_lock) {  in da7280_resume()
1293 		haptics->suspended = false;  in da7280_resume()
1326 MODULE_DESCRIPTION("DA7280 haptics driver");