93 static inline unsigned int reg_enable(struct bcm6345_l1_chip *intc,  in reg_enable()  argument
97 	return (1 * intc->n_words - word - 1) * sizeof(u32);  in reg_enable()
99 	return (0 * intc->n_words + word) * sizeof(u32);  in reg_enable()
103 static inline unsigned int reg_status(struct bcm6345_l1_chip *intc,  in reg_status()  argument
107 	return (2 * intc->n_words - word - 1) * sizeof(u32);  in reg_status()
109 	return (1 * intc->n_words + word) * sizeof(u32);  in reg_status()
113 static inline unsigned int cpu_for_irq(struct bcm6345_l1_chip *intc,  in cpu_for_irq()  argument
116 	return cpumask_first_and(&intc->cpumask, irq_data_get_affinity_mask(d));  in cpu_for_irq()
121 	struct bcm6345_l1_chip *intc = irq_desc_get_handler_data(desc);  in bcm6345_l1_irq_handle()  local
127 	cpu = intc->cpus[cpu_logical_map(smp_processor_id())];  in bcm6345_l1_irq_handle()
129 	cpu = intc->cpus[0];  in bcm6345_l1_irq_handle()
134 	for (idx = 0; idx < intc->n_words; idx++) {  in bcm6345_l1_irq_handle()
140 		pending = __raw_readl(cpu->map_base + reg_status(intc, idx));  in bcm6345_l1_irq_handle()
141 		pending &= __raw_readl(cpu->map_base + reg_enable(intc, idx));  in bcm6345_l1_irq_handle()
144 			irq = irq_linear_revmap(intc->domain, base + hwirq);  in bcm6345_l1_irq_handle()
157 	struct bcm6345_l1_chip *intc = irq_data_get_irq_chip_data(d);  in __bcm6345_l1_unmask()  local
160 	unsigned int cpu_idx = cpu_for_irq(intc, d);  in __bcm6345_l1_unmask()
162 	intc->cpus[cpu_idx]->enable_cache[word] |= mask;  in __bcm6345_l1_unmask()
163 	__raw_writel(intc->cpus[cpu_idx]->enable_cache[word],  in __bcm6345_l1_unmask()
164 		intc->cpus[cpu_idx]->map_base + reg_enable(intc, word));  in __bcm6345_l1_unmask()
169 	struct bcm6345_l1_chip *intc = irq_data_get_irq_chip_data(d);  in __bcm6345_l1_mask()  local
172 	unsigned int cpu_idx = cpu_for_irq(intc, d);  in __bcm6345_l1_mask()
174 	intc->cpus[cpu_idx]->enable_cache[word] &= ~mask;  in __bcm6345_l1_mask()
175 	__raw_writel(intc->cpus[cpu_idx]->enable_cache[word],  in __bcm6345_l1_mask()
176 		intc->cpus[cpu_idx]->map_base + reg_enable(intc, word));  in __bcm6345_l1_mask()
181 	struct bcm6345_l1_chip *intc = irq_data_get_irq_chip_data(d);  in bcm6345_l1_unmask()  local
184 	raw_spin_lock_irqsave(&intc->lock, flags);  in bcm6345_l1_unmask()
186 	raw_spin_unlock_irqrestore(&intc->lock, flags);  in bcm6345_l1_unmask()
191 	struct bcm6345_l1_chip *intc = irq_data_get_irq_chip_data(d);  in bcm6345_l1_mask()  local
194 	raw_spin_lock_irqsave(&intc->lock, flags);  in bcm6345_l1_mask()
196 	raw_spin_unlock_irqrestore(&intc->lock, flags);  in bcm6345_l1_mask()
203 	struct bcm6345_l1_chip *intc = irq_data_get_irq_chip_data(d);  in bcm6345_l1_set_affinity()  local
206 	unsigned int old_cpu = cpu_for_irq(intc, d);  in bcm6345_l1_set_affinity()
212 	if (!cpumask_and(&valid, &intc->cpumask, dest))  in bcm6345_l1_set_affinity()
221 	raw_spin_lock_irqsave(&intc->lock, flags);  in bcm6345_l1_set_affinity()
223 		enabled = intc->cpus[old_cpu]->enable_cache[word] & mask;  in bcm6345_l1_set_affinity()
232 	raw_spin_unlock_irqrestore(&intc->lock, flags);  in bcm6345_l1_set_affinity()
241 				      struct bcm6345_l1_chip *intc)  in bcm6345_l1_init_one()  argument
253 	if (!intc->n_words)  in bcm6345_l1_init_one()
254 		intc->n_words = n_words;  in bcm6345_l1_init_one()
255 	else if (intc->n_words != n_words)  in bcm6345_l1_init_one()
258 	cpu = intc->cpus[idx] = kzalloc(sizeof(*cpu) + n_words * sizeof(u32),  in bcm6345_l1_init_one()
269 		__raw_writel(0, cpu->map_base + reg_enable(intc, i));  in bcm6345_l1_init_one()
278 						bcm6345_l1_irq_handle, intc);  in bcm6345_l1_init_one()
308 	struct bcm6345_l1_chip *intc;  in bcm6345_l1_of_init()  local
312 	intc = kzalloc(sizeof(*intc), GFP_KERNEL);  in bcm6345_l1_of_init()
313 	if (!intc)  in bcm6345_l1_of_init()
317 		ret = bcm6345_l1_init_one(dn, idx, intc);  in bcm6345_l1_of_init()
319 			pr_err("failed to init intc L1 for cpu %d: %d\n",  in bcm6345_l1_of_init()
322 			cpumask_set_cpu(idx, &intc->cpumask);  in bcm6345_l1_of_init()
325 	if (!cpumask_weight(&intc->cpumask)) {  in bcm6345_l1_of_init()
330 	raw_spin_lock_init(&intc->lock);  in bcm6345_l1_of_init()
332 	intc->domain = irq_domain_add_linear(dn, IRQS_PER_WORD * intc->n_words,  in bcm6345_l1_of_init()
334 					     intc);  in bcm6345_l1_of_init()
335 	if (!intc->domain) {  in bcm6345_l1_of_init()
340 	pr_info("registered BCM6345 L1 intc (IRQs: %d)\n",  in bcm6345_l1_of_init()
341 			IRQS_PER_WORD * intc->n_words);  in bcm6345_l1_of_init()
342 	for_each_cpu(idx, &intc->cpumask) {  in bcm6345_l1_of_init()
343 		struct bcm6345_l1_cpu *cpu = intc->cpus[idx];  in bcm6345_l1_of_init()
353 		struct bcm6345_l1_cpu *cpu = intc->cpus[idx];  in bcm6345_l1_of_init()
362 	kfree(intc);  in bcm6345_l1_of_init()
366 IRQCHIP_DECLARE(bcm6345_l1, "brcm,bcm6345-l1-intc", bcm6345_l1_of_init);