22
22
23
23
#define PDC_MAX_GPIO_IRQS 256
24
24
25
+ /* Valid only on HW version < 3.2 */
25
26
#define IRQ_ENABLE_BANK 0x10
26
27
#define IRQ_i_CFG 0x110
27
28
29
+ /* Valid only on HW version >= 3.2 */
30
+ #define IRQ_i_CFG_IRQ_ENABLE 3
31
+
32
+ #define IRQ_i_CFG_TYPE_MASK GENMASK(2, 0)
33
+
34
+ #define PDC_VERSION_REG 0x1000
35
+
36
+ /* Notable PDC versions */
37
+ #define PDC_VERSION_3_2 0x30200
38
+
28
39
struct pdc_pin_region {
29
40
u32 pin_base ;
30
41
u32 parent_base ;
@@ -37,6 +48,7 @@ static DEFINE_RAW_SPINLOCK(pdc_lock);
37
48
static void __iomem * pdc_base ;
38
49
static struct pdc_pin_region * pdc_region ;
39
50
static int pdc_region_cnt ;
51
+ static unsigned int pdc_version ;
40
52
41
53
static void pdc_reg_write (int reg , u32 i , u32 val )
42
54
{
@@ -48,20 +60,32 @@ static u32 pdc_reg_read(int reg, u32 i)
48
60
return readl_relaxed (pdc_base + reg + i * sizeof (u32 ));
49
61
}
50
62
51
- static void pdc_enable_intr ( struct irq_data * d , bool on )
63
+ static void __pdc_enable_intr ( int pin_out , bool on )
52
64
{
53
- int pin_out = d -> hwirq ;
54
65
unsigned long enable ;
55
- unsigned long flags ;
56
- u32 index , mask ;
57
66
58
- index = pin_out / 32 ;
59
- mask = pin_out % 32 ;
67
+ if (pdc_version < PDC_VERSION_3_2 ) {
68
+ u32 index , mask ;
69
+
70
+ index = pin_out / 32 ;
71
+ mask = pin_out % 32 ;
72
+
73
+ enable = pdc_reg_read (IRQ_ENABLE_BANK , index );
74
+ __assign_bit (mask , & enable , on );
75
+ pdc_reg_write (IRQ_ENABLE_BANK , index , enable );
76
+ } else {
77
+ enable = pdc_reg_read (IRQ_i_CFG , pin_out );
78
+ __assign_bit (IRQ_i_CFG_IRQ_ENABLE , & enable , on );
79
+ pdc_reg_write (IRQ_i_CFG , pin_out , enable );
80
+ }
81
+ }
82
+
83
+ static void pdc_enable_intr (struct irq_data * d , bool on )
84
+ {
85
+ unsigned long flags ;
60
86
61
87
raw_spin_lock_irqsave (& pdc_lock , flags );
62
- enable = pdc_reg_read (IRQ_ENABLE_BANK , index );
63
- __assign_bit (mask , & enable , on );
64
- pdc_reg_write (IRQ_ENABLE_BANK , index , enable );
88
+ __pdc_enable_intr (d -> hwirq , on );
65
89
raw_spin_unlock_irqrestore (& pdc_lock , flags );
66
90
}
67
91
@@ -142,6 +166,7 @@ static int qcom_pdc_gic_set_type(struct irq_data *d, unsigned int type)
142
166
}
143
167
144
168
old_pdc_type = pdc_reg_read (IRQ_i_CFG , d -> hwirq );
169
+ pdc_type |= (old_pdc_type & ~IRQ_i_CFG_TYPE_MASK );
145
170
pdc_reg_write (IRQ_i_CFG , d -> hwirq , pdc_type );
146
171
147
172
ret = irq_chip_set_type_parent (d , type );
@@ -246,7 +271,6 @@ static const struct irq_domain_ops qcom_pdc_ops = {
246
271
static int pdc_setup_pin_mapping (struct device_node * np )
247
272
{
248
273
int ret , n , i ;
249
- u32 irq_index , reg_index , val ;
250
274
251
275
n = of_property_count_elems_of_size (np , "qcom,pdc-ranges" , sizeof (u32 ));
252
276
if (n <= 0 || n % 3 )
@@ -276,29 +300,38 @@ static int pdc_setup_pin_mapping(struct device_node *np)
276
300
if (ret )
277
301
return ret ;
278
302
279
- for (i = 0 ; i < pdc_region [n ].cnt ; i ++ ) {
280
- reg_index = (i + pdc_region [n ].pin_base ) >> 5 ;
281
- irq_index = (i + pdc_region [n ].pin_base ) & 0x1f ;
282
- val = pdc_reg_read (IRQ_ENABLE_BANK , reg_index );
283
- val &= ~BIT (irq_index );
284
- pdc_reg_write (IRQ_ENABLE_BANK , reg_index , val );
285
- }
303
+ for (i = 0 ; i < pdc_region [n ].cnt ; i ++ )
304
+ __pdc_enable_intr (i + pdc_region [n ].pin_base , 0 );
286
305
}
287
306
288
307
return 0 ;
289
308
}
290
309
310
+ #define QCOM_PDC_SIZE 0x30000
311
+
291
312
static int qcom_pdc_init (struct device_node * node , struct device_node * parent )
292
313
{
293
314
struct irq_domain * parent_domain , * pdc_domain ;
315
+ resource_size_t res_size ;
316
+ struct resource res ;
294
317
int ret ;
295
318
296
- pdc_base = of_iomap (node , 0 );
319
+ /* compat with old sm8150 DT which had very small region for PDC */
320
+ if (of_address_to_resource (node , 0 , & res ))
321
+ return - EINVAL ;
322
+
323
+ res_size = max_t (resource_size_t , resource_size (& res ), QCOM_PDC_SIZE );
324
+ if (res_size > resource_size (& res ))
325
+ pr_warn ("%pOF: invalid reg size, please fix DT\n" , node );
326
+
327
+ pdc_base = ioremap (res .start , res_size );
297
328
if (!pdc_base ) {
298
329
pr_err ("%pOF: unable to map PDC registers\n" , node );
299
330
return - ENXIO ;
300
331
}
301
332
333
+ pdc_version = pdc_reg_read (PDC_VERSION_REG , 0 );
334
+
302
335
parent_domain = irq_find_host (parent );
303
336
if (!parent_domain ) {
304
337
pr_err ("%pOF: unable to find PDC's parent domain\n" , node );
0 commit comments