- if(addr[p]&0x3f)
- return INTERRUP_PRIORITY_USED;
- *((volatile u32 *)(addr+p))=callback_addr;
- *((volatile u32 *)(cntl+p))=src_number&0x1f+(1<<5);
+ if(addr[priority]&0x3f)
+ return INTERRUPT_PRIORITY_USED;
+ *((volatile u32 *)(addr+priority))=callback_addr;
+ *((volatile u32 *)(cntl+priority))=(src_number&0x1f)+0x20;