修改4g拨号为QMI,需要在系统里后台执行quectel-CM

hc

2024-10-22 8ac6c7a54ed1b98d142dce24b11c6de6a1e239a5

 kernel/drivers/hid/hid-asus.c
..
..
@@ -95,6 +95,7 @@
95
95
 	struct hid_device *hdev;
96
96
 	struct work_struct work;
97
97
 	unsigned int brightness;
98
+	spinlock_t lock;
98
99
 	bool removed;
99
100
 };
100
101
 
..
..
@@ -397,24 +398,42 @@
397
398
 	return ret;
398
399
 }
399
400
 
401
+static void asus_schedule_work(struct asus_kbd_leds *led)
402
+{
403
+	unsigned long flags;
404
+
405
+	spin_lock_irqsave(&led->lock, flags);
406
+	if (!led->removed)
407
+		schedule_work(&led->work);
408
+	spin_unlock_irqrestore(&led->lock, flags);
409
+}
410
+
400
411
 static void asus_kbd_backlight_set(struct led_classdev *led_cdev,
401
412
 				   enum led_brightness brightness)
402
413
 {
403
414
 	struct asus_kbd_leds *led = container_of(led_cdev, struct asus_kbd_leds,
404
415
 						 cdev);
405
-	if (led->brightness == brightness)
406
-		return;
416
+	unsigned long flags;
407
417
 
418
+	spin_lock_irqsave(&led->lock, flags);
408
419
 	led->brightness = brightness;
409
-	schedule_work(&led->work);
420
+	spin_unlock_irqrestore(&led->lock, flags);
421
+
422
+	asus_schedule_work(led);
410
423
 }
411
424
 
412
425
 static enum led_brightness asus_kbd_backlight_get(struct led_classdev *led_cdev)
413
426
 {
414
427
 	struct asus_kbd_leds *led = container_of(led_cdev, struct asus_kbd_leds,
415
428
 						 cdev);
429
+	enum led_brightness brightness;
430
+	unsigned long flags;
416
431
 
417
-	return led->brightness;
432
+	spin_lock_irqsave(&led->lock, flags);
433
+	brightness = led->brightness;
434
+	spin_unlock_irqrestore(&led->lock, flags);
435
+
436
+	return brightness;
418
437
 }
419
438
 
420
439
 static void asus_kbd_backlight_work(struct work_struct *work)
..
..
@@ -422,11 +441,11 @@
422
441
 	struct asus_kbd_leds *led = container_of(work, struct asus_kbd_leds, work);
423
442
 	u8 buf[] = { FEATURE_KBD_REPORT_ID, 0xba, 0xc5, 0xc4, 0x00 };
424
443
 	int ret;
444
+	unsigned long flags;
425
445
 
426
-	if (led->removed)
427
-		return;
428
-
446
+	spin_lock_irqsave(&led->lock, flags);
429
447
 	buf[4] = led->brightness;
448
+	spin_unlock_irqrestore(&led->lock, flags);
430
449
 
431
450
 	ret = asus_kbd_set_report(led->hdev, buf, sizeof(buf));
432
451
 	if (ret < 0)
..
..
@@ -488,6 +507,7 @@
488
507
 	drvdata->kbd_backlight->cdev.brightness_set = asus_kbd_backlight_set;
489
508
 	drvdata->kbd_backlight->cdev.brightness_get = asus_kbd_backlight_get;
490
509
 	INIT_WORK(&drvdata->kbd_backlight->work, asus_kbd_backlight_work);
510
+	spin_lock_init(&drvdata->kbd_backlight->lock);
491
511
 
492
512
 	ret = devm_led_classdev_register(&hdev->dev, &drvdata->kbd_backlight->cdev);
493
513
 	if (ret < 0) {
..
..
@@ -1016,9 +1036,13 @@
1016
1036
 static void asus_remove(struct hid_device *hdev)
1017
1037
 {
1018
1038
 	struct asus_drvdata *drvdata = hid_get_drvdata(hdev);
1039
+	unsigned long flags;
1019
1040
 
1020
1041
 	if (drvdata->kbd_backlight) {
1042
+		spin_lock_irqsave(&drvdata->kbd_backlight->lock, flags);
1021
1043
 		drvdata->kbd_backlight->removed = true;
1044
+		spin_unlock_irqrestore(&drvdata->kbd_backlight->lock, flags);
1045
+
1022
1046
 		cancel_work_sync(&drvdata->kbd_backlight->work);
1023
1047
 	}
1024
1048