modify sin led gpio

hc

2024-05-13 9d77db3c730780c8ef5ccd4b66403ff5675cfe4e

 kernel/drivers/soc/rockchip/fiq_debugger/rk_fiq_debugger.c
..
..
@@ -179,11 +179,13 @@
179
179
 
180
180
 	if (lsr & UART_LSR_DR) {
181
181
 		temp = rk_fiq_read(t, UART_RX);
182
-		buf[n & 0x1f] = temp;
183
-		n++;
184
-		if (temp == 'q' && n > 2) {
185
-			if ((buf[(n - 2) & 0x1f] == 'i') &&
186
-			    (buf[(n - 3) & 0x1f] == 'f'))
182
+		buf[++n & 0x1f] = temp;
183
+
184
+		if (temp == 'q') {
185
+			if ((buf[(n - 1) & 0x1f] == 'i') &&
186
+			    (buf[(n - 2) & 0x1f] == 'f') &&
187
+			    (buf[(n - 3) & 0x1f] != '_') &&
188
+			    (buf[(n - 3) & 0x1f] != ' '))
187
189
 				return FIQ_DEBUGGER_BREAK;
188
190
 			else
189
191
 				return temp;
..
..
@@ -334,7 +336,7 @@
334
336
 		unsigned int dropped;
335
337
 
336
338
 		set_current_state(TASK_INTERRUPTIBLE);
337
-		if (kfifo_is_empty(&fifo) && kfifo_is_empty(&tty_fifo)) {
339
+		if (console_thread_stop || (kfifo_is_empty(&fifo) && kfifo_is_empty(&tty_fifo))) {
338
340
 			smp_store_mb(console_thread_running, false);
339
341
 			schedule();
340
342
 			smp_store_mb(console_thread_running, true);
..
..
@@ -344,13 +346,13 @@
344
346
 		set_current_state(TASK_RUNNING);
345
347
 
346
348
 		while (!console_thread_stop && (!kfifo_is_empty(&fifo) || !kfifo_is_empty(&tty_fifo))) {
347
-			while (kfifo_get(&fifo, &c)) {
349
+			while (!console_thread_stop && kfifo_get(&fifo, &c)) {
348
350
 				console_put(pdev, &c, 1);
349
351
 				if (c == '\n')
350
352
 					break;
351
353
 			}
352
354
 
353
-			while (kfifo_get(&tty_fifo, &c)) {
355
+			while (!console_thread_stop && kfifo_get(&tty_fifo, &c)) {
354
356
 				console_putc(pdev, c);
355
357
 				len_tty++;
356
358
 				if (c == '\n')
..
..
@@ -418,6 +420,8 @@
418
420
 	unsigned int ret = 0;
419
421
 	struct rk_fiq_debugger *t;
420
422
 
423
+	if (console_thread_stop)
424
+		return count;
421
425
 	t = container_of(dev_get_platdata(&pdev->dev), typeof(*t), pdata);
422
426
 
423
427
 	if (count > 0) {
..
..
@@ -759,6 +763,11 @@
759
763
 	if ((sip_fiq_debugger_is_enabled()) &&
760
764
 	    (sip_fiq_debugger_get_target_cpu() == cpu)) {
761
765
 		target_cpu = cpumask_any_but(cpu_online_mask, cpu);
766
+		if (target_cpu >= nr_cpu_ids) {
767
+			pr_err("%s: migrate fiq fail!\n", __func__);
768
+			return -EBUSY;
769
+		}
770
+
762
771
 		sip_fiq_debugger_switch_cpu(target_cpu);
763
772
 	}
764
773