Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) #include <linux/irq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include <asm/traps.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <asm/apollohw.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) unsigned int apollo_irq_startup(struct irq_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 	unsigned int irq = data->irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 	if (irq < 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 		*(volatile unsigned char *)(pica+1) &= ~(1 << irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 		*(volatile unsigned char *)(picb+1) &= ~(1 << (irq - 8));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) void apollo_irq_shutdown(struct irq_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	unsigned int irq = data->irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	if (irq < 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 		*(volatile unsigned char *)(pica+1) |= (1 << irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 		*(volatile unsigned char *)(picb+1) |= (1 << (irq - 8));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) void apollo_irq_eoi(struct irq_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	*(volatile unsigned char *)(pica) = 0x20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	*(volatile unsigned char *)(picb) = 0x20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) static struct irq_chip apollo_irq_chip = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	.name           = "apollo",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	.irq_startup    = apollo_irq_startup,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	.irq_shutdown   = apollo_irq_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	.irq_eoi	= apollo_irq_eoi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) void __init dn_init_IRQ(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	m68k_setup_user_interrupt(VEC_USER + 96, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	m68k_setup_irq_controller(&apollo_irq_chip, handle_fasteoi_irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 				  IRQ_APOLLO, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) }