touchscreen: gt9xxnew: Fix "Error: Driver 'gt9xxnew_ts' is already registered, aborting..."

Author: scpcom

drivers/input/touchscreen/gt9xxnew/gt9xx.c

@@ -3282,6 +3282,7 @@ static int startup(void)
 ********************************************************/
 static int goodix_ts_init(void)
 {
+	int ret = 0;
 #if !USE_DETECT
 	struct device_node *np = NULL;
 	char *p = NULL;
@@ -3312,11 +3313,20 @@ static int goodix_ts_init(void)
 	gtp_esd_check_workqueue = create_workqueue("gtp_esd_check");
 #endif
 
-	i2c_add_driver(&goodix_ts_driver);
-	if (config_info.probed)
-		return 0;
-	else
-		return -1;
+	ret = i2c_add_driver(&goodix_ts_driver);
+	if ((!ret) && (!config_info.probed))
+		ret = -1;
+	if (ret)
+		goto err_register;
+	return 0;
+
+err_register:
+	i2c_del_driver(&goodix_ts_driver);
+	if (goodix_wq) {
+		destroy_workqueue(goodix_wq);
+		goodix_wq = NULL;
+	}
+	return ret;
 }
 
 /*******************************************************
@@ -3333,6 +3343,7 @@ static void __exit goodix_ts_exit(void)
 	i2c_del_driver(&goodix_ts_driver);
 	if (goodix_wq) {
 		destroy_workqueue(goodix_wq);
+		goodix_wq = NULL;
 	}
 	input_set_power_enable(&(config_info.input_type), 0);
 	input_sensor_free(&(config_info.input_type));