系统处理 IRQ_EINT0 IRQ_EINT11 的过程

本文详细分析了S3C2410处理器处理IRQ_EINT0和IRQ_EINT11中断的过程,从中断向量存放位置、中断处理流程、中断识别机制等方面入手,揭示了中断系统的工作原理。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

【转载】:http://blog.chinaunix.net/uid-20902140-id-1831989.html/


主要分析系统处理 IRQ_EINT0 IRQ_EINT11 的过程。


2440处理器的中断组织成两层:主中断 和 次中断,一共可以处理60个中断源。

主中断 和 次中断 经过中断构架的抽象之后,编写驱动程序时,我们不用考虑这两层中断,直接使用
request_irq 注册 60个中断源的某个,就可以直接使用中断了。

        err = request_irq(button_irqs[i].irq, buttons_interrupt, NULL,
                          button_irqs[i].name, (void *)&button_irqs[i]);
        set_irq_type(button_irqs[i].irq, IRQT_BOTHEDGE);
像上面这样使用中断。

下面是主中断0~31共32个中断源(32bit)

/* main cpu interrupts */
#define IRQ_EINT0      S3C2410_IRQ(0)        /* 16 */
#define IRQ_EINT1      S3C2410_IRQ(1)
#define IRQ_EINT2      S3C2410_IRQ(2)
#define IRQ_EINT3      S3C2410_IRQ(3)
#define IRQ_EINT4t7    S3C2410_IRQ(4)        /* 20 */
#define IRQ_EINT8t23   S3C2410_IRQ(5)
#define IRQ_RESERVED6  S3C2410_IRQ(6)        /* for s3c2410 */
#define IRQ_CAM        S3C2410_IRQ(6)        /* for s3c2440 */
#define IRQ_BATT_FLT   S3C2410_IRQ(7)
#define IRQ_TICK       S3C2410_IRQ(8)        /* 24 */
#define IRQ_WDT           S3C2410_IRQ(9)
#define IRQ_TIMER0     S3C2410_IRQ(10)
#define IRQ_TIMER1     S3C2410_IRQ(11)
#define IRQ_TIMER2     S3C2410_IRQ(12)
#define IRQ_TIMER3     S3C2410_IRQ(13)
#define IRQ_TIMER4     S3C2410_IRQ(14)
#define IRQ_UART2      S3C2410_IRQ(15)
#define IRQ_LCD           S3C2410_IRQ(16)        /* 32 */
#define IRQ_DMA0       S3C2410_IRQ(17)
#define IRQ_DMA1       S3C2410_IRQ(18)
#define IRQ_DMA2       S3C2410_IRQ(19)
#define IRQ_DMA3       S3C2410_IRQ(20)
#define IRQ_SDI           S3C2410_IRQ(21)
#define IRQ_SPI0       S3C2410_IRQ(22)
#define IRQ_UART1      S3C2410_IRQ(23)
#define IRQ_RESERVED24 S3C2410_IRQ(24)        /* 40 */
#define IRQ_NFCON      S3C2410_IRQ(24)        /* for s3c2440 */
#define IRQ_USBD       S3C2410_IRQ(25)
#define IRQ_USBH       S3C2410_IRQ(26)
#define IRQ_IIC           S3C2410_IRQ(27)
#define IRQ_UART0      S3C2410_IRQ(28)        /* 44 */
#define IRQ_SPI1       S3C2410_IRQ(29)
#define IRQ_RTC           S3C2410_IRQ(30)
#define IRQ_ADCPARENT  S3C2410_IRQ(31)

其中IRQ_EINT4t7,IRQ_EINT8t23,IRQ_CAM,IRQ_WDT,IRQ_LCD,IRQ_ADCPARENT,IRQ_UART0,IRQ_UART1,
IRQ_UART2,这9个主中断下面还有次中断,实际的中断源来自次中断,所以要分清到底是硬件的那个部分产生了中断,还要下
潜到次中断,才能查看到底是那里发生了中断。上面的9个主中断并不属于60个中断源之一,因为他们只是表征了次中断的发生
与否。具体的次中断才是60个中断源之一。次中断组织如下。

/* interrupts generated from the external interrupts sources */
#define IRQ_EINT4      S3C2410_IRQ(32)       /* 48 */
#define IRQ_EINT5      S3C2410_IRQ(33)
#define IRQ_EINT6      S3C2410_IRQ(34)
#define IRQ_EINT7      S3C2410_IRQ(35)
#define IRQ_EINT8      S3C2410_IRQ(36)
#define IRQ_EINT9      S3C2410_IRQ(37)
#define IRQ_EINT10     S3C2410_IRQ(38)
#define IRQ_EINT11     S3C2410_IRQ(39)
#define IRQ_EINT12     S3C2410_IRQ(40)
#define IRQ_EINT13     S3C2410_IRQ(41)
#define IRQ_EINT14     S3C2410_IRQ(42)
#define IRQ_EINT15     S3C2410_IRQ(43)
#define IRQ_EINT16     S3C2410_IRQ(44)
#define IRQ_EINT17     S3C2410_IRQ(45)
#define IRQ_EINT18     S3C2410_IRQ(46)
#define IRQ_EINT19     S3C2410_IRQ(47)
#define IRQ_EINT20     S3C2410_IRQ(48)       /* 64 */
#define IRQ_EINT21     S3C2410_IRQ(49)
#define IRQ_EINT22     S3C2410_IRQ(50)
#define IRQ_EINT23     S3C2410_IRQ(51)


#define IRQ_EINT(x)    S3C2410_IRQ((x >= 4) ? (IRQ_EINT4 + (x) - 4) : (S3C2410_IRQ(0) + (x)))

#define IRQ_LCD_FIFO   S3C2410_IRQ(52)
#define IRQ_LCD_FRAME  S3C2410_IRQ(53)

/* IRQs for the interal UARTs, and ADC
 * these need to be ordered in number of appearance in the
 * SUBSRC mask register
*/
#define IRQ_S3CUART_RX0  S3C2410_IRQ(54)   /* 70 */
#define IRQ_S3CUART_TX0  S3C2410_IRQ(55)   /* 71 */
#define IRQ_S3CUART_ERR0 S3C2410_IRQ(56)

#define IRQ_S3CUART_RX1  S3C2410_IRQ(57)
#define IRQ_S3CUART_TX1  S3C2410_IRQ(58)
#define IRQ_S3CUART_ERR1 S3C2410_IRQ(59)

#define IRQ_S3CUART_RX2  S3C2410_IRQ(60)
#define IRQ_S3CUART_TX2  S3C2410_IRQ(61)
#define IRQ_S3CUART_ERR2 S3C2410_IRQ(62)

#define IRQ_TC         S3C2410_IRQ(63)
#define IRQ_ADC         S3C2410_IRQ(64)

/* extra irqs for s3c2440 */

#define IRQ_S3C2440_CAM_C    S3C2410_IRQ(65)
#define IRQ_S3C2440_CAM_P    S3C2410_IRQ(66)
#define IRQ_S3C2440_WDT        S3C2410_IRQ(67)
#define IRQ_S3C2440_AC97    S3C2410_IRQ(68) //68+1-9=60,正好是60个中断源。

#define NR_IRQS (IRQ_S3C2440_AC97+1)
这里确定了中断源个数,代表着 irq_desc 的数组大小
也表征了本处理器能够处理的最多的irq中断个数。

假如现在发生了IRQ_EINT0 或者 IRQ_EINT11中断,分析下中断处理的过程。
中断向量在那里呢?
那是在 start_kernel() -> trap_init(),

memcpy((void *)0xffff0000, __vectors_start, __vectors_end - __vectors_start);
memcpy((void *)0xffff0200, __stubs_start, __stubs_end - __stubs_start);

linux用0xffff0000位置存放中断向量,所以中断向量被拷贝到了虚拟地址0xffff0000位置处。

.globl    __vectors_start
__vectors_start:
    swi    SYS_ERROR0
    b    vector_und + stubs_offset
    ldr    pc, .LCvswi + stubs_offset
    b    vector_pabt + stubs_offset
    b    vector_dabt + stubs_offset
    b    vector_addrexcptn + stubs_offset
    b    vector_irq + stubs_offset
    b    vector_fiq + stubs_offset

    .globl    __vectors_end
__vectors_end:

这样,当我们的IRQ_EINT0 或者 IRQ_EINT11中断发生时,    b    vector_irq + stubs_offset这条语句就被执行了。
程序跳转到了vector_irq + stubs_offset的位置。
那么vector_irq + stubs_offset在哪里?是什么内容呢?


.globl    __stubs_start
__stubs_start:
/*
 * Interrupt dispatcher
 */
    vector_stub    irq, 4

    .long    __irq_usr            @  0  (USR_26 / USR_32)
    .long    __irq_invalid            @  1  (FIQ_26 / FIQ_32)
    .long    __irq_invalid            @  2  (IRQ_26 / IRQ_32)
    .long    __irq_svc            @  3  (SVC_26 / SVC_32)
    .long    __irq_invalid            @  4
    .long    __irq_invalid            @  5
    .long    __irq_invalid            @  6
    .long    __irq_invalid            @  7
    .long    __irq_invalid            @  8
    .long    __irq_invalid            @  9
    .long    __irq_invalid            @  a
    .long    __irq_invalid            @  b
    .long    __irq_invalid            @  c
    .long    __irq_invalid            @  d
    .long    __irq_invalid            @  e
    .long    __irq_invalid            @  f

上面的.long就是跳转表,只有两个有效,用户态和系统态

......

    .globl    __stubs_end
__stubs_end:

    .equ    stubs_offset, __vectors_start + 0x200 - __stubs_start




其中vector_stub是个宏,他的作用是调整返回地址的位置,保存r0和返回地址,进入irq模式之前的cpsr到irq的堆栈中,进入管理模式,
根据进入irq模式之前的cpsr内容(中断是从用户态还是系统态发生的),索引正确的跳转表。

假设中断发生在用户态。
那么要到__irq_usr走一趟了。

.align    5
__irq_usr:

    ...

    irq_handler

    ...

    b    ret_to_user

    .ltorg

忽略不感兴趣的部分,这段程序的主体是irq_handler。
在找irq_handler。他是个宏。

    .macro    irq_handler
1:    get_irqnr_and_base r0, r6, r5, lr
    movne    r1, sp
    @
    @ routine called with r0 = irq number, r1 = struct pt_regs *
    @
    adrne    lr, 1b
    bne    asm_do_IRQ

    .endm

见到希望了,可以肯定是get_irqnr_and_base确定的具体中断号。然后调用asm_do_IRQ来完成我们在驱动程序中
request_irq()注册的中断处理函数的调用。asm_do_IRQ()在《嵌入式开发详解》里有详细的介绍了。

去看看get_irqnr_and_base是怎么得到我们想要的 IRQ_EINT0 IRQ_EINT11对应的中断号的?
它都能识别出那些中断源发出的中断?


.macro    get_irqnr_and_base, irqnr, irqstat, base, tmp

        mov    \tmp, #S3C24XX_VA_IRQ 取得中断控制寄存器(mem IO)的虚拟地址
        ldr    \irqnr, [ \tmp, #0x14 ]        @ get irq no 取得INTOFFSET寄存器的值,取值范围是0~31哦(其实他的值就代表了主中断号)。
30000:
        teq    \irqnr, #4
        teqne    \irqnr, #5
        beq    1002f                @ external irq reg

EINT4_7  4
EINT8_23 5
主中断号4,5 分别是扩展io主中断,这两个bit之一置位,说明有外io中断发生(我的按键中断就在EINT8_23里),跳到前面
标号1002处,如果没有,代码向下继续运行。假设  IRQ_EINT0中断(不是EINT4_7,EINT8_23),那么继续往下走。

        @ debug check to see if interrupt reported is the same
        @ as the offset....

        teq    \irqnr, #0 检查是不是真的有中断发生,如果IRQ_EINT0中断,这里感知不到的
        beq    20002f

如果没有中断发生,跳到前面20002标号处,假如EINT8_23中断,代码继续往下运行。

        ldr    \irqstat, [ \tmp, #0x10 ]    @ INTPND
        mov    \irqstat, \irqstat, lsr \irqnr
        tst    \irqstat, #1
        bne    20002f

取得INTPND寄存器的值,这个寄存器表征了主中断的发生与否,经过以 INTOFFSET右移,测试他的第INTOFFSET bit,看看是不是
真的有中断发生有中断发生,如果第INTOFFSET bit 为1,那么tst的结果为真,也就是不等于0,bne有效,跳到了前面20002出口处,
现在的irqstat表示有无中断了,0:无,1:有。

        /* debug/warning if we get an invalud response from the
         * INTOFFSET register */
#if 1
        stmfd    r13!, { r0 - r4 , r8-r12, r14 }
        ldr    r1,    [ \tmp, #0x14 ]        @ INTOFFSET
        ldr    r2,    [ \tmp, #0x10 ]        @ INTPND
        ldr    r3,    [ \tmp, #0x00 ]        @ SRCPND
        adr    r0, 20003f
        bl    printk
        b    20004f

20003:
        .ascii    "<7>irq: err - bad offset %d, intpnd=%08x, srcpnd=%08x\n"
        .byte    0
        .align    4
20004:
        mov    r1, #1
        mov    \tmp, #S3C24XX_VA_IRQ
        ldmfd    r13!, { r0 - r4 , r8-r12, r14 }
#endif

        @ try working out interrupt number for ourselves
        mov    \irqnr, #0
        ldr    \irqstat, [ \tmp, #0x10 ]    @ INTPND
10021:
        movs    \irqstat, \irqstat, lsr#1
        bcs    30000b        @ try and re-start the proccess
        add    \irqnr, \irqnr, #1
        cmp    \irqnr, #32
        ble    10021b

        @ found no interrupt, set Z flag and leave
        movs    \irqnr, #0
        b    1001f

上面这段是对中断寄存器INTOFFSET指示出错的处理,代码很健壮阿,不感兴趣。

20005:
20002:        @ exit
        @ we base the s3c2410x interrupts at 16 and above to allow
        @ isa peripherals to have their standard interrupts, also
        @ ensure that Z flag is un-set on exit

        @ note, we cannot be sure if we get IRQ_EINT0 (0) that
        @ there is simply no interrupt pending, so in all other
        @ cases we jump to say we have found something, otherwise
        @ we check to see if the interrupt really is assrted
        adds    \irqnr, \irqnr, #IRQ_EINT0
        teq    \irqnr, #IRQ_EINT0
        bne    1001f                @ exit

只要irqnr(INTOFFSET)不是0,就是说有中断发生,那么这里就表示已经找到了中断了,并且将中断号在intoffset的基础上+16。
16是中断偏移,前16个中断是留给isa peripherals的,然后就出去。

当程序运行到这里时,表示irqnr(INTOFFSET)是0,也就说可能是IRQ_EINT0中断。
        ldr    \irqstat, [ \tmp, #0x10 ]    @ INTPND
        teq    \irqstat, #0
        moveq    \irqnr, #0
        b    1001f
如果这时INTPND为0,表示没有IRQ_EINT0中断,那么将irqnr设为0,退出。否则就表示是IRQ_EINT0中断,这时的中断号为16哦,退出。
其实这里应该总是不相等的,也就是说 “irqnr设为0,退出” 的机会很渺茫的。

        @ we get here from no main or external interrupts pending
1002:

如果到了这里,说明有外io中断(EINT4~EINT23)发生(我的按键中断就在EINT8_23里),那么识别子中断的过程在这里完成,
现在的内核代码已经不再这样作了。

        add    \tmp, \tmp, #S3C24XX_VA_GPIO - S3C24XX_VA_IRQ @取得gpio IO mem的虚拟地址
        ldr    \irqstat, [ \tmp, # 0xa8 ]    @ EXTINTPEND
        ldr    \irqnr, [ \tmp, # 0xa4 ]    @ EXTINTMASK

        bic    \irqstat, \irqstat, \irqnr    @ clear masked irqs

        mov    \irqnr, #IRQ_EINT4        @ start extint nos
        mov    \irqstat, \irqstat, lsr#4    @ ignore bottom 4 bits
10021:
        movs    \irqstat, \irqstat, lsr#1
        bcs    1004f
        add    \irqnr, \irqnr, #1
        cmp    \irqnr, #IRQ_EINT23
        ble    10021b

        @ found no interrupt, set Z flag and leave
        movs    \irqnr, #0

1004:        @ ensure Z flag clear in case our MOVS shifted out the last bit
        teq    \irqnr, #0
1001:
        @ exit irq routine
        .endm
到这里,子中断(EINT4~EINT23)的识别过程就结束了。可见在这个宏里,中断的识别过程分成了两部分
1。主中断的识别过程
2。EINT4~EINT23次中断的识别过程。

从此以后,系统就调用do_asm_IRQ()来处理中断了,do_asm_IRQ()会根据上面这个宏识别出来的中断号,去调用具体的中断处理例程
比如do_level_IRQ(),do_edge_IRQ(),s3c_irq_demux_uart0(),s3c_irq_demux_adc()等等。中断号可以是0~51(包括
主中断号 和 EINT4~EINT23),而51~68之间的中断号在主中断号上的识别就要靠主中断中的相应demux handler了,他们的识别是第2级识别,
不是在上面的宏里能识别的。

系统的irq中断就是这么给安装的。
调用路径为:start_kernel() -> init_IRQ() -> init_arch_irq() -> s3c24xx_init_irq()


/* s3c24xx_init_irq
 *
 * Initialise S3C2410 IRQ system
*/

void __init s3c24xx_init_irq(void)
{
    unsigned long pend;
    unsigned long last;
    int irqno;
    int i;

    irqdbf("s3c2410_init_irq: clearing interrupt status flags\n");

    /* first, clear all interrupts pending... */

    last = 0;
    for (i = 0; i < 4; i++) {
        pend = __raw_readl(S3C2410_EINTPEND);

        if (pend == 0 || pend == last)
            break;

        __raw_writel(pend, S3C2410_EINTPEND);
        printk("irq: clearing pending ext status %08x\n", (int)pend);
        last = pend;
    }

    last = 0;
    for (i = 0; i < 4; i++) {
        pend = __raw_readl(S3C2410_INTPND);

        if (pend == 0 || pend == last)
            break;

        __raw_writel(pend, S3C2410_SRCPND);
        __raw_writel(pend, S3C2410_INTPND);
        printk("irq: clearing pending status %08x\n", (int)pend);
        last = pend;
    }

    last = 0;
    for (i = 0; i < 4; i++) {
        pend = __raw_readl(S3C2410_SUBSRCPND);

        if (pend == 0 || pend == last)
            break;

        printk("irq: clearing subpending status %08x\n", (int)pend);
        __raw_writel(pend, S3C2410_SUBSRCPND);
        last = pend;
    }

    /* register the main interrupts */

    irqdbf("s3c2410_init_irq: registering s3c2410 interrupt handlers\n");

    for (irqno = IRQ_BATT_FLT; irqno <= IRQ_ADCPARENT; irqno++) {
        /* set all the s3c2410 internal irqs */

        switch (irqno) {
            /* deal with the special IRQs (cascaded) */

        case IRQ_UART0:
        case IRQ_UART1:
        case IRQ_UART2:
        case IRQ_ADCPARENT:
            set_irq_chip(irqno, &s3c_irq_level_chip);
            set_irq_handler(irqno, do_level_IRQ);
            break;

        case IRQ_RESERVED6:
        case IRQ_RESERVED24:
            /* no IRQ here */
            break;

        default:
            //irqdbf("registering irq %d (s3c irq)\n", irqno);
            set_irq_chip(irqno, &s3c_irq_chip);
            set_irq_handler(irqno, do_edge_IRQ);
            set_irq_flags(irqno, IRQF_VALID);
        }
    }

    /* setup the cascade irq handlers */
//这里就是可以识别的级联的次中断所在的主中断号。asm_do_IRQ()会调用这些函数,以便先识别出来到底是那个中断源发出的次中断
    set_irq_chained_handler(IRQ_UART0, s3c_irq_demux_uart0);
    set_irq_chained_handler(IRQ_UART1, s3c_irq_demux_uart1);
    set_irq_chained_handler(IRQ_UART2, s3c_irq_demux_uart2);
    set_irq_chained_handler(IRQ_ADCPARENT, s3c_irq_demux_adc);


    /* external interrupts */

    for (irqno = IRQ_EINT0; irqno <= IRQ_EINT3; irqno++) {
        irqdbf("registering irq %d (ext int)\n", irqno);
        set_irq_chip(irqno, &s3c_irq_eint0t4);
        set_irq_handler(irqno, do_edge_IRQ);
        set_irq_flags(irqno, IRQF_VALID);
    }

    for (irqno = IRQ_EINT4; irqno <= IRQ_EINT23; irqno++) {
        irqdbf("registering irq %d (extended s3c irq)\n", irqno);
        set_irq_chip(irqno, &s3c_irqext_chip);
        set_irq_handler(irqno, do_edge_IRQ);
        set_irq_flags(irqno, IRQF_VALID);
    }

    /* register the uart interrupts */

    irqdbf("s3c2410: registering external interrupts\n");

    for (irqno = IRQ_S3CUART_RX0; irqno <= IRQ_S3CUART_ERR0; irqno++) {
        irqdbf("registering irq %d (s3c uart0 irq)\n", irqno);
        set_irq_chip(irqno, &s3c_irq_uart0);
        set_irq_handler(irqno, do_level_IRQ);
        set_irq_flags(irqno, IRQF_VALID);
    }

    for (irqno = IRQ_S3CUART_RX1; irqno <= IRQ_S3CUART_ERR1; irqno++) {
        irqdbf("registering irq %d (s3c uart1 irq)\n", irqno);
        set_irq_chip(irqno, &s3c_irq_uart1);
        set_irq_handler(irqno, do_level_IRQ);
        set_irq_flags(irqno, IRQF_VALID);
    }

    for (irqno = IRQ_S3CUART_RX2; irqno <= IRQ_S3CUART_ERR2; irqno++) {
        irqdbf("registering irq %d (s3c uart2 irq)\n", irqno);
        set_irq_chip(irqno, &s3c_irq_uart2);
        set_irq_handler(irqno, do_level_IRQ);
        set_irq_flags(irqno, IRQF_VALID);
    }

    for (irqno = IRQ_TC; irqno <= IRQ_ADC; irqno++) {
        irqdbf("registering irq %d (s3c adc irq)\n", irqno);
        set_irq_chip(irqno, &s3c_irq_adc);
        set_irq_handler(irqno, do_edge_IRQ);
        set_irq_flags(irqno, IRQF_VALID);
    }

    irqdbf("s3c2410: registered interrupt handlers\n");
}

可以发现,这里没有安装IRQ_EINT4t7,IRQ_EINT8t23,IRQ_CAM 主中断对应的中断handler,
而且对应的handler全是do_level_IRQ,和do_edge_IRQ。
其中
        IRQ_UART0
        IRQ_UART1:
        IRQ_UART2:
        IRQ_ADCPARENT:
用的是电平触发,其他的全是边缘触发。
刚才分析过了IRQ_EINT4t7,IRQ_EINT8t23,可以在get_irqnr_and_base中直接识别出来具体的中断源,
所以IRQ_EINT4t7,IRQ_EINT8t23对应的那个irq_desc[]可以没有handler函数,而IRQ_CAM也没有,这将导致
linux系统不能识别IRQ_CAM中断,从而无法服务camera中断???那么当camera需要中断的时候,应该怎么半呢?
这里留下了个疑问。 看晕了,原来
    set_irq_chained_handler(IRQ_UART0, s3c_irq_demux_uart0);
    set_irq_chained_handler(IRQ_UART1, s3c_irq_demux_uart1);
    set_irq_chained_handler(IRQ_UART2, s3c_irq_demux_uart2);
    set_irq_chained_handler(IRQ_ADCPARENT, s3c_irq_demux_adc);
上面的四个句子,会覆盖掉switch语句设置的主中断handler,
这使
switch (irqno) {
            /* deal with the special IRQs (cascaded) */

        case IRQ_UART0:
        case IRQ_UART1:
        case IRQ_UART2:
        case IRQ_ADCPARENT:
            set_irq_chip(irqno, &s3c_irq_level_chip);
            set_irq_handler(irqno, do_level_IRQ);
            break;
这个分支的set_irq_handler显得罗嗦。
而且现在的内核已经把外io中断的具体识别过程放到了demux函数中
    set_irq_chained_handler(IRQ_EINT4t7, s3c_irq_demux_extint4t7);
    set_irq_chained_handler(IRQ_EINT8t23, s3c_irq_demux_extint8);

    set_irq_chained_handler(IRQ_UART0, s3c_irq_demux_uart0);
    set_irq_chained_handler(IRQ_UART1, s3c_irq_demux_uart1);
    set_irq_chained_handler(IRQ_UART2, s3c_irq_demux_uart2);
    set_irq_chained_handler(IRQ_ADCPARENT, s3c_irq_demux_adc);

IRQ_CAM,IRQ_WDT,IRQ_LCD的下面不也是有子中断吗,为什么没有
demux函数呢,以后碰到这个问题在分析了。
static irqreturn_t accdet_eint_func(int irq, void *data) 500 { 501 int ret = 0; 502 503 ACCDET_DEBUG("[Accdet]Enter accdet_eint_func !!!!!!\n"); 504 if (cur_eint_state == EINT_PIN_PLUG_IN) { 505 /* 506 To trigger EINT when the headset was plugged in 507 We set the polarity back as we initialed. 508 */ 509 #ifndef CONFIG_ACCDET_EINT_IRQ 510 if (accdet_eint_type == IRQ_TYPE_LEVEL_HIGH) 511 irq_set_irq_type(accdet_irq, IRQ_TYPE_LEVEL_HIGH); 512 else 513 irq_set_irq_type(accdet_irq, IRQ_TYPE_LEVEL_LOW); 514 #endif 515 #ifdef CONFIG_ACCDET_EINT_IRQ 516 pmic_pwrap_write(ACCDET_EINT_CTL, pmic_pwrap_read(ACCDET_EINT_CTL) & (~(7 << 4))); 517 /*debounce=256ms*/ 518 pmic_pwrap_write(ACCDET_EINT_CTL, pmic_pwrap_read(ACCDET_EINT_CTL) | EINT_IRQ_DE_IN); 519 pmic_pwrap_write(ACCDET_DEBOUNCE3, cust_headset_settings->debounce3); 520 521 #else 522 gpio_set_debounce(gpiopin, headsetdebounce); 523 #endif 524 525 /* update the eint status */ 526 cur_eint_state = EINT_PIN_PLUG_OUT; 527 } else { 528 /* 529 To trigger EINT when the headset was plugged out 530 We set the opposite polarity to what we initialed. 531 */ 532 #ifndef CONFIG_ACCDET_EINT_IRQ 533 if (accdet_eint_type == IRQ_TYPE_LEVEL_HIGH) 534 irq_set_irq_type(accdet_irq, IRQ_TYPE_LEVEL_LOW); 535 else 536 irq_set_irq_type(accdet_irq, IRQ_TYPE_LEVEL_HIGH); 537 #endif 538 539 #ifdef CONFIG_ACCDET_EINT_IRQ 540 pmic_pwrap_write(ACCDET_EINT_CTL, pmic_pwrap_read(ACCDET_EINT_CTL) & (~(7 << 4))); 541 /*debounce=16ms*/ 542 pmic_pwrap_write(ACCDET_EINT_CTL, pmic_pwrap_read(ACCDET_EINT_CTL) | EINT_IRQ_DE_OUT); 543 #else 544 gpio_set_debounce(gpiopin, accdet_dts_data.accdet_plugout_debounce * 1000); 545 #endif 546 /* update the eint status */ 547 cur_eint_state = EINT_PIN_PLUG_IN; 548 549 mod_timer(&micbias_timer, jiffies + MICBIAS_DISABLE_TIMER); 550 } 551 #ifndef CONFIG_ACCDET_EINT_IRQ 552 disable_irq_nosync(accdet_irq); 553 #endif 554 ACCDET_DEBUG("[Accdet]accdet_eint_func after cur_eint_state=%d\n", cur_eint_state); 555 556 ret = queue_work(accdet_eint_workqueue, &accdet_eint_work); 557 return IRQ_HANDLED; 558 } 559 #ifndef CONFIG_ACCDET_EINT_IRQ 560 static inline int accdet_setup_eint(struct platform_device *accdet_device) 561 { 562 int ret; 563 u32 ints[2] = { 0, 0 }; 564 u32 ints1[2] = { 0, 0 }; 565 struct device_node *node = NULL; 566 struct pinctrl_state *pins_default; 567 568 /*configure to GPIO function, external interrupt */ 569 ACCDET_INFO("[Accdet]accdet_setup_eint\n"); 570 accdet_pinctrl1 = devm_pinctrl_get(&accdet_device->dev); 571 if (IS_ERR(accdet_pinctrl1)) { 572 ret = PTR_ERR(accdet_pinctrl1); 573 dev_err(&accdet_device->dev, "fwq Cannot find accdet accdet_pinctrl1!\n"); 574 return ret; 575 } 576 577 pins_default = pinctrl_lookup_state(accdet_pinctrl1, "default"); 578 if (IS_ERR(pins_default)) { 579 ret = PTR_ERR(pins_default); 580 /*dev_err(&accdet_device->dev, "fwq Cannot find accdet pinctrl default!\n");*/ 581 } 582 583 pins_eint_int = pinctrl_lookup_state(accdet_pinctrl1, "state_eint_as_int"); 584 if (IS_ERR(pins_eint_int)) { 585 ret = PTR_ERR(pins_eint_int); 586 dev_err(&accdet_device->dev, "fwq Cannot find accdet pinctrl state_eint_accdet!\n"); 587 return ret; 588 } 589 pinctrl_select_state(accdet_pinctrl1, pins_eint_int); 590 591 /*node = of_find_matching_node(node, accdet_of_match);*/ 592 node = of_find_matching_node(node, accdet_of_match); 593 if (node) { 594 of_property_read_u32_array(node, "debounce", ints, ARRAY_SIZE(ints)); 595 of_property_read_u32_array(node, "interrupts", ints1, ARRAY_SIZE(ints1)); 596 gpiopin = ints[0]; 597 headsetdebounce = ints[1]; 598 accdet_eint_type = ints1[1]; 599 gpio_set_debounce(gpiopin, headsetdebounce); 600 accdet_irq = irq_of_parse_and_map(node, 0); 601 ret = request_irq(accdet_irq, accdet_eint_func, IRQF_TRIGGER_NONE, "accdet-eint", NULL); 602 if (ret != 0) { 603 ACCDET_ERROR("[Accdet]EINT IRQ LINE NOT AVAILABLE\n"); 604 } else { 605 ACCDET_ERROR("[Accdet]accdet set EINT finished, accdet_irq=%d, headsetdebounce=%d\n", 606 accdet_irq, headsetdebounce); 607 } 608 } else { 609 ACCDET_ERROR("[Accdet]%s can't find compatible node\n", __func__); 610 } 611 return 0; 612 }
07-15
/*clear ACCDET IRQ in accdet register*/ 814 static inline void clear_accdet_interrupt(void) 815 { 816 /*it is safe by using polling to adjust when to clear IRQ_CLR_BIT*/ 817 pmic_pwrap_write(ACCDET_IRQ_STS, ((pmic_pwrap_read(ACCDET_IRQ_STS)) & 0x8000) | (IRQ_CLR_BIT)); 818 ACCDET_DEBUG("[Accdet]clear_accdet_interrupt: ACCDET_IRQ_STS = 0x%x\n", pmic_pwrap_read(ACCDET_IRQ_STS)); 819 } 820 821 static inline void clear_accdet_eint_interrupt(void) 822 { 823 pmic_pwrap_write(ACCDET_IRQ_STS, (((pmic_pwrap_read(ACCDET_IRQ_STS)) & 0x8000) | IRQ_EINT_CLR_BIT)); 824 ACCDET_DEBUG("[Accdet]clear_accdet_eint_interrupt: ACCDET_IRQ_STS = 0x%x\n", pmic_pwrap_read(ACCDET_IRQ_STS)); 825 } 826 827 static inline void check_cable_type(void) 828 { 829 int current_status = 0; 830 int irq_temp = 0; /*for clear IRQ_bit*/ 831 int wait_clear_irq_times = 0; 832 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 833 int pin_adc_value = 0; 834 #define PIN_ADC_CHANNEL 5 835 #endif 836 837 current_status = ((pmic_pwrap_read(ACCDET_STATE_RG) & 0xc0) >> 6); /*A=bit1; B=bit0*/ 838 ACCDET_DEBUG("[Accdet]accdet interrupt happen:[%s]current AB = %d\n", 839 accdet_status_string[accdet_status], current_status); 840 841 button_status = 0; 842 pre_status = accdet_status; 843 844 /*ACCDET_DEBUG("[Accdet]check_cable_type: ACCDET_IRQ_STS = 0x%x\n", pmic_pwrap_read(ACCDET_IRQ_STS));*/ 845 IRQ_CLR_FLAG = false; 846 switch (accdet_status) { 847 case PLUG_OUT: 848 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 849 pmic_pwrap_write(ACCDET_DEBOUNCE1, cust_headset_settings->debounce1); 850 #endif 851 if (current_status == 0) { 852 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 853 /*micbias always on during detected PIN recognition*/ 854 pmic_pwrap_write(ACCDET_PWM_WIDTH, cust_headset_settings->pwm_width); 855 pmic_pwrap_write(ACCDET_PWM_THRESH, cust_headset_settings->pwm_width); 856 ACCDET_DEBUG("[Accdet]PIN recognition micbias always on!\n"); 857 ACCDET_DEBUG("[Accdet]before adc read, pin_adc_value = %d mv!\n", pin_adc_value); 858 msleep(500); 859 current_status = ((pmic_pwrap_read(ACCDET_STATE_RG) & 0xc0) >> 6); /*A=bit1; B=bit0*/ 860 if (current_status == 0 && show_icon_delay != 0) { 861 /*accdet_auxadc_switch(1);switch on when need to use auxadc read voltage*/ 862 pin_adc_value = Accdet_PMIC_IMM_GetOneChannelValue(1); 863 ACCDET_DEBUG("[Accdet]pin_adc_value = %d mv!\n", pin_adc_value); 864 /*accdet_auxadc_switch(0);*/ 865 if (180 > pin_adc_value && pin_adc_value > 90) { /*90mv ilegal headset*/ 866 /*mt_set_gpio_out(GPIO_CAMERA_2_CMRST_PIN, GPIO_OUT_ONE);*/ 867 /*ACCDET_DEBUG("[Accdet]PIN recognition change GPIO_OUT!\n");*/ 868 mutex_lock(&accdet_eint_irq_sync_mutex); 869 if (1 == eint_accdet_sync_flag) { 870 cable_type = HEADSET_NO_MIC; 871 accdet_status = HOOK_SWITCH; 872 cable_pin_recognition = 1; 873 ACCDET_DEBUG("[Accdet] cable_pin_recognition = %d\n", 874 cable_pin_recognition); 875 } else { 876 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 877 } 878 mutex_unlock(&accdet_eint_irq_sync_mutex); 879 } else { 880 mutex_lock(&accdet_eint_irq_sync_mutex); 881 if (1 == eint_accdet_sync_flag) { 882 cable_type = HEADSET_NO_MIC; 883 accdet_status = HOOK_SWITCH; 884 } else { 885 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 886 } 887 mutex_unlock(&accdet_eint_irq_sync_mutex); 888 } 889 } 890 #else 891 mutex_lock(&accdet_eint_irq_sync_mutex); 892 if (1 == eint_accdet_sync_flag) { 893 cable_type = HEADSET_NO_MIC; 894 accdet_status = HOOK_SWITCH; 895 } else { 896 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 897 } 898 mutex_unlock(&accdet_eint_irq_sync_mutex); 899 #endif 900 } else if (current_status == 1) { 901 mutex_lock(&accdet_eint_irq_sync_mutex); 902 if (1 == eint_accdet_sync_flag) { 903 accdet_status = MIC_BIAS; 904 cable_type = HEADSET_MIC; 905 /*AB=11 debounce=30ms*/ 906 pmic_pwrap_write(ACCDET_DEBOUNCE3, cust_headset_settings->debounce3 * 30); 907 } else { 908 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 909 } 910 mutex_unlock(&accdet_eint_irq_sync_mutex); 911 pmic_pwrap_write(ACCDET_DEBOUNCE0, button_press_debounce); 912 /*recover polling set AB 00-01*/ 913 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 914 pmic_pwrap_write(ACCDET_PWM_WIDTH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 915 pmic_pwrap_write(ACCDET_PWM_THRESH, REGISTER_VALUE(cust_headset_settings->pwm_thresh)); 916 #endif 917 } else if (current_status == 3) { 918 ACCDET_DEBUG("[Accdet]PLUG_OUT state not change!\n"); 919 #ifdef CONFIG_ACCDET_EINT 920 ACCDET_DEBUG("[Accdet] do not send plug out event in plug out\n"); 921 #else 922 mutex_lock(&accdet_eint_irq_sync_mutex); 923 if (1 == eint_accdet_sync_flag) { 924 accdet_status = PLUG_OUT; 925 cable_type = NO_DEVICE; 926 } else { 927 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 928 } 929 mutex_unlock(&accdet_eint_irq_sync_mutex); 930 #endif 931 } else { 932 ACCDET_DEBUG("[Accdet]PLUG_OUT can't change to this state!\n"); 933 } 934 break; 935 936 case MIC_BIAS: 937 /*solution: resume hook switch debounce time*/ 938 pmic_pwrap_write(ACCDET_DEBOUNCE0, cust_headset_settings->debounce0); 939 940 if (current_status == 0) { 941 mutex_lock(&accdet_eint_irq_sync_mutex); 942 if (1 == eint_accdet_sync_flag) { 943 while ((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT) 944 && (wait_clear_irq_times < 3)) { 945 ACCDET_DEBUG("[Accdet]check_cable_type: MIC BIAS clear IRQ on-going1....\n"); 946 wait_clear_irq_times++; 947 msleep(20); 948 } 949 irq_temp = pmic_pwrap_read(ACCDET_IRQ_STS); 950 irq_temp = irq_temp & (~IRQ_CLR_BIT); 951 pmic_pwrap_write(ACCDET_IRQ_STS, irq_temp); 952 IRQ_CLR_FLAG = true; 953 accdet_status = HOOK_SWITCH; 954 } else { 955 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 956 } 957 mutex_unlock(&accdet_eint_irq_sync_mutex); 958 button_status = 1; 959 if (button_status) { 960 mutex_lock(&accdet_eint_irq_sync_mutex); 961 if (1 == eint_accdet_sync_flag) 962 multi_key_detection(current_status); 963 else 964 ACCDET_DEBUG("[Accdet] multi_key_detection: Headset has plugged out\n"); 965 mutex_unlock(&accdet_eint_irq_sync_mutex); 966 /*accdet_auxadc_switch(0);*/ 967 /*recover pwm frequency and duty*/ 968 pmic_pwrap_write(ACCDET_PWM_WIDTH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 969 pmic_pwrap_write(ACCDET_PWM_THRESH, REGISTER_VALUE(cust_headset_settings->pwm_thresh)); 970 } 971 } else if (current_status == 1) { 972 mutex_lock(&accdet_eint_irq_sync_mutex); 973 if (1 == eint_accdet_sync_flag) { 974 accdet_status = MIC_BIAS; 975 cable_type = HEADSET_MIC; 976 ACCDET_DEBUG("[Accdet]MIC_BIAS state not change!\n"); 977 } else { 978 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 979 } 980 mutex_unlock(&accdet_eint_irq_sync_mutex); 981 } else if (current_status == 3) { 982 #if defined CONFIG_ACCDET_EINT || defined CONFIG_ACCDET_EINT_IRQ 983 ACCDET_DEBUG("[Accdet]do not send plug ou in micbiast\n"); 984 mutex_lock(&accdet_eint_irq_sync_mutex); 985 if (1 == eint_accdet_sync_flag) 986 accdet_status = PLUG_OUT; 987 else 988 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 989 mutex_unlock(&accdet_eint_irq_sync_mutex); 990 #else 991 mutex_lock(&accdet_eint_irq_sync_mutex); 992 if (1 == eint_accdet_sync_flag) { 993 accdet_status = PLUG_OUT; 994 cable_type = NO_DEVICE; 995 } else { 996 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 997 } 998 mutex_unlock(&accdet_eint_irq_sync_mutex); 999 #endif 1000 } else { 1001 ACCDET_DEBUG("[Accdet]MIC_BIAS can't change to this state!\n"); 1002 } 1003 break; 1004 1005 case HOOK_SWITCH: 1006 if (current_status == 0) { 1007 mutex_lock(&accdet_eint_irq_sync_mutex); 1008 if (1 == eint_accdet_sync_flag) { 1009 /*for avoid 01->00 framework of Headset will report press key info for Audio*/ 1010 /*cable_type = HEADSET_NO_MIC;*/ 1011 /*accdet_status = HOOK_SWITCH;*/ 1012 ACCDET_DEBUG("[Accdet]HOOK_SWITCH state not change!\n"); 1013 } else { 1014 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1015 } 1016 mutex_unlock(&accdet_eint_irq_sync_mutex); 1017 } else if (current_status == 1) { 1018 mutex_lock(&accdet_eint_irq_sync_mutex); 1019 if (1 == eint_accdet_sync_flag) { 1020 multi_key_detection(current_status); 1021 accdet_status = MIC_BIAS; 1022 cable_type = HEADSET_MIC; 1023 } else { 1024 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1025 } 1026 mutex_unlock(&accdet_eint_irq_sync_mutex); 1027 /*accdet_auxadc_switch(0);*/ 1028 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 1029 cable_pin_recognition = 0; 1030 ACCDET_DEBUG("[Accdet] cable_pin_recognition = %d\n", cable_pin_recognition); 1031 pmic_pwrap_write(ACCDET_PWM_WIDTH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 1032 pmic_pwrap_write(ACCDET_PWM_THRESH, REGISTER_VALUE(cust_headset_settings->pwm_thresh)); 1033 #endif 1034 /*solution: reduce hook switch debounce time to 0x400*/ 1035 pmic_pwrap_write(ACCDET_DEBOUNCE0, button_press_debounce); 1036 } else if (current_status == 3) { 1037 1038 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 1039 cable_pin_recognition = 0; 1040 ACCDET_DEBUG("[Accdet] cable_pin_recognition = %d\n", cable_pin_recognition); 1041 mutex_lock(&accdet_eint_irq_sync_mutex); 1042 if (1 == eint_accdet_sync_flag) 1043 accdet_status = PLUG_OUT; 1044 else 1045 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1046 mutex_unlock(&accdet_eint_irq_sync_mutex); 1047 #endif 1048 #if defined CONFIG_ACCDET_EINT || defined CONFIG_ACCDET_EINT_IRQ 1049 ACCDET_DEBUG("[Accdet] do not send plug out event in hook switch\n"); 1050 mutex_lock(&accdet_eint_irq_sync_mutex); 1051 if (1 == eint_accdet_sync_flag) 1052 accdet_status = PLUG_OUT; 1053 else 1054 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1055 mutex_unlock(&accdet_eint_irq_sync_mutex); 1056 #else 1057 mutex_lock(&accdet_eint_irq_sync_mutex); 1058 if (1 == eint_accdet_sync_flag) { 1059 accdet_status = PLUG_OUT; 1060 cable_type = NO_DEVICE; 1061 } else { 1062 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1063 } 1064 mutex_unlock(&accdet_eint_irq_sync_mutex); 1065 #endif 1066 } else { 1067 ACCDET_DEBUG("[Accdet]HOOK_SWITCH can't change to this state!\n"); 1068 } 1069 break; 1070 case STAND_BY: 1071 if (current_status == 3) { 1072 #if defined CONFIG_ACCDET_EINT || defined CONFIG_ACCDET_EINT_IRQ 1073 ACCDET_DEBUG("[Accdet]accdet do not send plug out event in stand by!\n"); 1074 #else 1075 mutex_lock(&accdet_eint_irq_sync_mutex); 1076 if (1 == eint_accdet_sync_flag) { 1077 accdet_status = PLUG_OUT; 1078 cable_type = NO_DEVICE; 1079 } else { 1080 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1081 } 1082 mutex_unlock(&accdet_eint_irq_sync_mutex); 1083 #endif 1084 } else { 1085 ACCDET_DEBUG("[Accdet]STAND_BY can't change to this state!\n"); 1086 } 1087 break; 1088 1089 default: 1090 ACCDET_DEBUG("[Accdet]check_cable_type: accdet current status error!\n"); 1091 break; 1092 1093 } 1094 1095 if (!IRQ_CLR_FLAG) { 1096 mutex_lock(&accdet_eint_irq_sync_mutex); 1097 if (1 == eint_accdet_sync_flag) { 1098 while ((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT) && (wait_clear_irq_times < 3)) { 1099 ACCDET_DEBUG("[Accdet]check_cable_type: Clear interrupt on-going2....\n"); 1100 wait_clear_irq_times++; 1101 msleep(20); 1102 } 1103 } 1104 irq_temp = pmic_pwrap_read(ACCDET_IRQ_STS); 1105 irq_temp = irq_temp & (~IRQ_CLR_BIT); 1106 pmic_pwrap_write(ACCDET_IRQ_STS, irq_temp); 1107 mutex_unlock(&accdet_eint_irq_sync_mutex); 1108 IRQ_CLR_FLAG = true; 1109 ACCDET_DEBUG("[Accdet]check_cable_type:Clear interrupt:Done[0x%x]!\n", pmic_pwrap_read(ACCDET_IRQ_STS)); 1110 1111 } else { 1112 IRQ_CLR_FLAG = false; 1113 } 1114 1115 ACCDET_DEBUG("[Accdet]cable type:[%s], status switch:[%s]->[%s]\n", 1116 accdet_report_string[cable_type], accdet_status_string[pre_status], 1117 accdet_status_string[accdet_status]); 1118 }
07-15
解析这个函数:static inline void check_cable_type(void) 828 { 829 int current_status = 0; 830 int irq_temp = 0; /*for clear IRQ_bit*/ 831 int wait_clear_irq_times = 0; 832 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 833 int pin_adc_value = 0; 834 #define PIN_ADC_CHANNEL 5 835 #endif 836 837 current_status = ((pmic_pwrap_read(ACCDET_STATE_RG) & 0xc0) >> 6); /*A=bit1; B=bit0*/ 838 ACCDET_DEBUG("[Accdet]accdet interrupt happen:[%s]current AB = %d\n", 839 accdet_status_string[accdet_status], current_status); 840 841 button_status = 0; 842 pre_status = accdet_status; 843 844 /*ACCDET_DEBUG("[Accdet]check_cable_type: ACCDET_IRQ_STS = 0x%x\n", pmic_pwrap_read(ACCDET_IRQ_STS));*/ 845 IRQ_CLR_FLAG = false; 846 switch (accdet_status) { 847 case PLUG_OUT: 848 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 849 pmic_pwrap_write(ACCDET_DEBOUNCE1, cust_headset_settings->debounce1); 850 #endif 851 if (current_status == 0) { 852 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 853 /*micbias always on during detected PIN recognition*/ 854 pmic_pwrap_write(ACCDET_PWM_WIDTH, cust_headset_settings->pwm_width); 855 pmic_pwrap_write(ACCDET_PWM_THRESH, cust_headset_settings->pwm_width); 856 ACCDET_DEBUG("[Accdet]PIN recognition micbias always on!\n"); 857 ACCDET_DEBUG("[Accdet]before adc read, pin_adc_value = %d mv!\n", pin_adc_value); 858 msleep(500); 859 current_status = ((pmic_pwrap_read(ACCDET_STATE_RG) & 0xc0) >> 6); /*A=bit1; B=bit0*/ 860 if (current_status == 0 && show_icon_delay != 0) { 861 /*accdet_auxadc_switch(1);switch on when need to use auxadc read voltage*/ 862 pin_adc_value = Accdet_PMIC_IMM_GetOneChannelValue(1); 863 ACCDET_DEBUG("[Accdet]pin_adc_value = %d mv!\n", pin_adc_value); 864 /*accdet_auxadc_switch(0);*/ 865 if (180 > pin_adc_value && pin_adc_value > 90) { /*90mv ilegal headset*/ 866 /*mt_set_gpio_out(GPIO_CAMERA_2_CMRST_PIN, GPIO_OUT_ONE);*/ 867 /*ACCDET_DEBUG("[Accdet]PIN recognition change GPIO_OUT!\n");*/ 868 mutex_lock(&accdet_eint_irq_sync_mutex); 869 if (1 == eint_accdet_sync_flag) { 870 cable_type = HEADSET_NO_MIC; 871 accdet_status = HOOK_SWITCH; 872 cable_pin_recognition = 1; 873 ACCDET_DEBUG("[Accdet] cable_pin_recognition = %d\n", 874 cable_pin_recognition); 875 } else { 876 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 877 } 878 mutex_unlock(&accdet_eint_irq_sync_mutex); 879 } else { 880 mutex_lock(&accdet_eint_irq_sync_mutex); 881 if (1 == eint_accdet_sync_flag) { 882 cable_type = HEADSET_NO_MIC; 883 accdet_status = HOOK_SWITCH; 884 } else { 885 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 886 } 887 mutex_unlock(&accdet_eint_irq_sync_mutex); 888 } 889 } 890 #else 891 mutex_lock(&accdet_eint_irq_sync_mutex); 892 if (1 == eint_accdet_sync_flag) { 893 cable_type = HEADSET_NO_MIC; 894 accdet_status = HOOK_SWITCH; 895 } else { 896 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 897 } 898 mutex_unlock(&accdet_eint_irq_sync_mutex); 899 #endif 900 } else if (current_status == 1) { 901 mutex_lock(&accdet_eint_irq_sync_mutex); 902 if (1 == eint_accdet_sync_flag) { 903 accdet_status = MIC_BIAS; 904 cable_type = HEADSET_MIC; 905 /*AB=11 debounce=30ms*/ 906 pmic_pwrap_write(ACCDET_DEBOUNCE3, cust_headset_settings->debounce3 * 30); 907 } else { 908 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 909 } 910 mutex_unlock(&accdet_eint_irq_sync_mutex); 911 pmic_pwrap_write(ACCDET_DEBOUNCE0, button_press_debounce); 912 /*recover polling set AB 00-01*/ 913 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 914 pmic_pwrap_write(ACCDET_PWM_WIDTH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 915 pmic_pwrap_write(ACCDET_PWM_THRESH, REGISTER_VALUE(cust_headset_settings->pwm_thresh)); 916 #endif 917 } else if (current_status == 3) { 918 ACCDET_DEBUG("[Accdet]PLUG_OUT state not change!\n"); 919 #ifdef CONFIG_ACCDET_EINT 920 ACCDET_DEBUG("[Accdet] do not send plug out event in plug out\n"); 921 #else 922 mutex_lock(&accdet_eint_irq_sync_mutex); 923 if (1 == eint_accdet_sync_flag) { 924 accdet_status = PLUG_OUT; 925 cable_type = NO_DEVICE; 926 } else { 927 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 928 } 929 mutex_unlock(&accdet_eint_irq_sync_mutex); 930 #endif 931 } else { 932 ACCDET_DEBUG("[Accdet]PLUG_OUT can't change to this state!\n"); 933 } 934 break; 935 936 case MIC_BIAS: 937 /*solution: resume hook switch debounce time*/ 938 pmic_pwrap_write(ACCDET_DEBOUNCE0, cust_headset_settings->debounce0); 939 940 if (current_status == 0) { 941 mutex_lock(&accdet_eint_irq_sync_mutex); 942 if (1 == eint_accdet_sync_flag) { 943 while ((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT) 944 && (wait_clear_irq_times < 3)) { 945 ACCDET_DEBUG("[Accdet]check_cable_type: MIC BIAS clear IRQ on-going1....\n"); 946 wait_clear_irq_times++; 947 msleep(20); 948 } 949 irq_temp = pmic_pwrap_read(ACCDET_IRQ_STS); 950 irq_temp = irq_temp & (~IRQ_CLR_BIT); 951 pmic_pwrap_write(ACCDET_IRQ_STS, irq_temp); 952 IRQ_CLR_FLAG = true; 953 accdet_status = HOOK_SWITCH; 954 } else { 955 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 956 } 957 mutex_unlock(&accdet_eint_irq_sync_mutex); 958 button_status = 1; 959 if (button_status) { 960 mutex_lock(&accdet_eint_irq_sync_mutex); 961 if (1 == eint_accdet_sync_flag) 962 multi_key_detection(current_status); 963 else 964 ACCDET_DEBUG("[Accdet] multi_key_detection: Headset has plugged out\n"); 965 mutex_unlock(&accdet_eint_irq_sync_mutex); 966 /*accdet_auxadc_switch(0);*/ 967 /*recover pwm frequency and duty*/ 968 pmic_pwrap_write(ACCDET_PWM_WIDTH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 969 pmic_pwrap_write(ACCDET_PWM_THRESH, REGISTER_VALUE(cust_headset_settings->pwm_thresh)); 970 } 971 } else if (current_status == 1) { 972 mutex_lock(&accdet_eint_irq_sync_mutex); 973 if (1 == eint_accdet_sync_flag) { 974 accdet_status = MIC_BIAS; 975 cable_type = HEADSET_MIC; 976 ACCDET_DEBUG("[Accdet]MIC_BIAS state not change!\n"); 977 } else { 978 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 979 } 980 mutex_unlock(&accdet_eint_irq_sync_mutex); 981 } else if (current_status == 3) { 982 #if defined CONFIG_ACCDET_EINT || defined CONFIG_ACCDET_EINT_IRQ 983 ACCDET_DEBUG("[Accdet]do not send plug ou in micbiast\n"); 984 mutex_lock(&accdet_eint_irq_sync_mutex); 985 if (1 == eint_accdet_sync_flag) 986 accdet_status = PLUG_OUT; 987 else 988 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 989 mutex_unlock(&accdet_eint_irq_sync_mutex); 990 #else 991 mutex_lock(&accdet_eint_irq_sync_mutex); 992 if (1 == eint_accdet_sync_flag) { 993 accdet_status = PLUG_OUT; 994 cable_type = NO_DEVICE; 995 } else { 996 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 997 } 998 mutex_unlock(&accdet_eint_irq_sync_mutex); 999 #endif 1000 } else { 1001 ACCDET_DEBUG("[Accdet]MIC_BIAS can't change to this state!\n"); 1002 } 1003 break; 1004 1005 case HOOK_SWITCH: 1006 if (current_status == 0) { 1007 mutex_lock(&accdet_eint_irq_sync_mutex); 1008 if (1 == eint_accdet_sync_flag) { 1009 /*for avoid 01->00 framework of Headset will report press key info for Audio*/ 1010 /*cable_type = HEADSET_NO_MIC;*/ 1011 /*accdet_status = HOOK_SWITCH;*/ 1012 ACCDET_DEBUG("[Accdet]HOOK_SWITCH state not change!\n"); 1013 } else { 1014 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1015 } 1016 mutex_unlock(&accdet_eint_irq_sync_mutex); 1017 } else if (current_status == 1) { 1018 mutex_lock(&accdet_eint_irq_sync_mutex); 1019 if (1 == eint_accdet_sync_flag) { 1020 multi_key_detection(current_status); 1021 accdet_status = MIC_BIAS; 1022 cable_type = HEADSET_MIC; 1023 } else { 1024 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1025 } 1026 mutex_unlock(&accdet_eint_irq_sync_mutex); 1027 /*accdet_auxadc_switch(0);*/ 1028 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 1029 cable_pin_recognition = 0; 1030 ACCDET_DEBUG("[Accdet] cable_pin_recognition = %d\n", cable_pin_recognition); 1031 pmic_pwrap_write(ACCDET_PWM_WIDTH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 1032 pmic_pwrap_write(ACCDET_PWM_THRESH, REGISTER_VALUE(cust_headset_settings->pwm_thresh)); 1033 #endif 1034 /*solution: reduce hook switch debounce time to 0x400*/ 1035 pmic_pwrap_write(ACCDET_DEBOUNCE0, button_press_debounce); 1036 } else if (current_status == 3) { 1037 1038 #ifdef CONFIG_ACCDET_PIN_RECOGNIZATION 1039 cable_pin_recognition = 0; 1040 ACCDET_DEBUG("[Accdet] cable_pin_recognition = %d\n", cable_pin_recognition); 1041 mutex_lock(&accdet_eint_irq_sync_mutex); 1042 if (1 == eint_accdet_sync_flag) 1043 accdet_status = PLUG_OUT; 1044 else 1045 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1046 mutex_unlock(&accdet_eint_irq_sync_mutex); 1047 #endif 1048 #if defined CONFIG_ACCDET_EINT || defined CONFIG_ACCDET_EINT_IRQ 1049 ACCDET_DEBUG("[Accdet] do not send plug out event in hook switch\n"); 1050 mutex_lock(&accdet_eint_irq_sync_mutex); 1051 if (1 == eint_accdet_sync_flag) 1052 accdet_status = PLUG_OUT; 1053 else 1054 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1055 mutex_unlock(&accdet_eint_irq_sync_mutex); 1056 #else 1057 mutex_lock(&accdet_eint_irq_sync_mutex); 1058 if (1 == eint_accdet_sync_flag) { 1059 accdet_status = PLUG_OUT; 1060 cable_type = NO_DEVICE; 1061 } else { 1062 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1063 } 1064 mutex_unlock(&accdet_eint_irq_sync_mutex); 1065 #endif 1066 } else { 1067 ACCDET_DEBUG("[Accdet]HOOK_SWITCH can't change to this state!\n"); 1068 } 1069 break; 1070 case STAND_BY: 1071 if (current_status == 3) { 1072 #if defined CONFIG_ACCDET_EINT || defined CONFIG_ACCDET_EINT_IRQ 1073 ACCDET_DEBUG("[Accdet]accdet do not send plug out event in stand by!\n"); 1074 #else 1075 mutex_lock(&accdet_eint_irq_sync_mutex); 1076 if (1 == eint_accdet_sync_flag) { 1077 accdet_status = PLUG_OUT; 1078 cable_type = NO_DEVICE; 1079 } else { 1080 ACCDET_DEBUG("[Accdet] Headset has plugged out\n"); 1081 } 1082 mutex_unlock(&accdet_eint_irq_sync_mutex); 1083 #endif 1084 } else { 1085 ACCDET_DEBUG("[Accdet]STAND_BY can't change to this state!\n"); 1086 } 1087 break; 1088 1089 default: 1090 ACCDET_DEBUG("[Accdet]check_cable_type: accdet current status error!\n"); 1091 break; 1092 1093 } 1094 1095 if (!IRQ_CLR_FLAG) { 1096 mutex_lock(&accdet_eint_irq_sync_mutex); 1097 if (1 == eint_accdet_sync_flag) { 1098 while ((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT) && (wait_clear_irq_times < 3)) { 1099 ACCDET_DEBUG("[Accdet]check_cable_type: Clear interrupt on-going2....\n"); 1100 wait_clear_irq_times++; 1101 msleep(20); 1102 } 1103 } 1104 irq_temp = pmic_pwrap_read(ACCDET_IRQ_STS); 1105 irq_temp = irq_temp & (~IRQ_CLR_BIT); 1106 pmic_pwrap_write(ACCDET_IRQ_STS, irq_temp); 1107 mutex_unlock(&accdet_eint_irq_sync_mutex); 1108 IRQ_CLR_FLAG = true; 1109 ACCDET_DEBUG("[Accdet]check_cable_type:Clear interrupt:Done[0x%x]!\n", pmic_pwrap_read(ACCDET_IRQ_STS)); 1110 1111 } else { 1112 IRQ_CLR_FLAG = false; 1113 } 1114 1115 ACCDET_DEBUG("[Accdet]cable type:[%s], status switch:[%s]->[%s]\n", 1116 accdet_report_string[cable_type], accdet_status_string[pre_status], 1117 accdet_status_string[accdet_status]); 1118 }
最新发布
07-15
static void send_accdet_status_event(int cable_type, int status) 664 { 665 switch (cable_type) { 666 case HEADSET_NO_MIC: 667 input_report_switch(kpd_accdet_dev, SW_HEADPHONE_INSERT, status); 668 input_report_switch(kpd_accdet_dev, SW_JACK_PHYSICAL_INSERT, status); 669 input_sync(kpd_accdet_dev); 670 ACCDET_DEBUG("[Accdet]HEADSET_NO_MIC(3-pole) %s\n", status?"PlugIn":"PlugOut"); 671 break; 672 case HEADSET_MIC: 673 input_report_switch(kpd_accdet_dev, SW_HEADPHONE_INSERT, status); 674 input_report_switch(kpd_accdet_dev, SW_MICROPHONE_INSERT, status); 675 input_report_switch(kpd_accdet_dev, SW_JACK_PHYSICAL_INSERT, status); 676 input_sync(kpd_accdet_dev); 677 ACCDET_DEBUG("[Accdet]HEADSET_MIC(4-pole) %s\n", status?"PlugIn":"PlugOut"); 678 break; 679 default: 680 ACCDET_DEBUG("[Accdet]Invalid cableType\n"); 681 } 682 } 683 684 static void send_key_event(int keycode, int flag) 685 { 686 switch (keycode) { 687 case DW_KEY: 688 input_report_key(kpd_accdet_dev, KEY_VOLUMEDOWN, flag); 689 input_sync(kpd_accdet_dev); 690 ACCDET_DEBUG("[accdet]KEY_VOLUMEDOWN %d\n", flag); 691 break; 692 case UP_KEY: 693 input_report_key(kpd_accdet_dev, KEY_VOLUMEUP, flag); 694 input_sync(kpd_accdet_dev); 695 ACCDET_DEBUG("[accdet]KEY_VOLUMEUP %d\n", flag); 696 break; 697 case MD_KEY: 698 input_report_key(kpd_accdet_dev, KEY_PLAYPAUSE, flag); 699 input_sync(kpd_accdet_dev); 700 ACCDET_DEBUG("[accdet]KEY_PLAYPAUSE %d\n", flag); 701 break; 702 case AS_KEY: 703 input_report_key(kpd_accdet_dev, KEY_VOICECOMMAND, flag); 704 input_sync(kpd_accdet_dev); 705 ACCDET_DEBUG("[accdet]KEY_VOICECOMMAND %d\n", flag); 706 break; 707 } 708 } 709 710 static void multi_key_detection(int current_status) 711 { 712 int m_key = 0; 713 int cali_voltage = 0; 714 715 if (0 == current_status) { 716 cali_voltage = Accdet_PMIC_IMM_GetOneChannelValue(1); 717 /*ACCDET_DEBUG("[Accdet]adc cali_voltage1 = %d mv\n", cali_voltage);*/ 718 m_key = cur_key = key_check(cali_voltage); 719 } 720 mdelay(30); 721 #ifdef CONFIG_ACCDET_EINT_IRQ 722 if (((pmic_pwrap_read(ACCDET_IRQ_STS) & EINT_IRQ_STATUS_BIT) != EINT_IRQ_STATUS_BIT) || eint_accdet_sync_flag) { 723 #else /* ifdef CONFIG_ACCDET_EINT */ 724 if (((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT) != IRQ_STATUS_BIT) || eint_accdet_sync_flag) { 725 #endif 726 send_key_event(cur_key, !current_status); 727 } else { 728 ACCDET_DEBUG("[Accdet]plug out side effect key press, do not report key = %d\n", cur_key); 729 cur_key = NO_KEY; 730 } 731 if (current_status) 732 cur_key = NO_KEY; 733 } 734 #endif 735 static void accdet_workqueue_func(void) 736 { 737 int ret; 738 739 ret = queue_work(accdet_workqueue, &accdet_work); 740 if (!ret) 741 ACCDET_DEBUG("[Accdet]accdet_work return:%d!\n", ret); 742 } 743 744 int accdet_irq_handler(void) 745 { 746 u64 cur_time = 0; 747 748 cur_time = accdet_get_current_time(); 749 750 #ifdef CONFIG_ACCDET_EINT_IRQ 751 ACCDET_DEBUG("[Accdet accdet_irq_handler]clear_accdet_eint_interrupt: ACCDET_IRQ_STS = 0x%x\n", 752 pmic_pwrap_read(ACCDET_IRQ_STS)); 753 if ((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT) 754 && ((pmic_pwrap_read(ACCDET_IRQ_STS) & EINT_IRQ_STATUS_BIT) != EINT_IRQ_STATUS_BIT)) { 755 clear_accdet_interrupt(); 756 if (accdet_status == MIC_BIAS) { 757 /*accdet_auxadc_switch(1);*/ 758 pmic_pwrap_write(ACCDET_PWM_WIDTH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 759 pmic_pwrap_write(ACCDET_PWM_THRESH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 760 } 761 accdet_workqueue_func(); 762 while (((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT) 763 && (accdet_timeout_ns(cur_time, ACCDET_TIME_OUT)))) 764 ; 765 } else if ((pmic_pwrap_read(ACCDET_IRQ_STS) & EINT_IRQ_STATUS_BIT) == EINT_IRQ_STATUS_BIT) { 766 if (cur_eint_state == EINT_PIN_PLUG_IN) { 767 if (accdet_eint_type == IRQ_TYPE_LEVEL_HIGH) 768 pmic_pwrap_write(ACCDET_IRQ_STS, pmic_pwrap_read(ACCDET_IRQ_STS) | EINT_IRQ_POL_HIGH); 769 else 770 pmic_pwrap_write(ACCDET_IRQ_STS, pmic_pwrap_read(ACCDET_IRQ_STS) & ~EINT_IRQ_POL_LOW); 771 } else { 772 if (accdet_eint_type == IRQ_TYPE_LEVEL_HIGH) 773 pmic_pwrap_write(ACCDET_IRQ_STS, pmic_pwrap_read(ACCDET_IRQ_STS) & ~EINT_IRQ_POL_LOW); 774 else 775 pmic_pwrap_write(ACCDET_IRQ_STS, pmic_pwrap_read(ACCDET_IRQ_STS) | EINT_IRQ_POL_HIGH); 776 } 777 clear_accdet_eint_interrupt(); 778 while (((pmic_pwrap_read(ACCDET_IRQ_STS) & EINT_IRQ_STATUS_BIT) 779 && (accdet_timeout_ns(cur_time, ACCDET_TIME_OUT)))) 780 ; 781 accdet_eint_func(accdet_irq, NULL); 782 } else { 783 ACCDET_DEBUG("ACCDET IRQ and EINT IRQ don't be triggerred!!\n"); 784 } 785 #else 786 if ((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT)) 787 clear_accdet_interrupt(); 788 if (accdet_status == MIC_BIAS) { 789 /*accdet_auxadc_switch(1);*/ 790 pmic_pwrap_write(ACCDET_PWM_WIDTH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 791 pmic_pwrap_write(ACCDET_PWM_THRESH, REGISTER_VALUE(cust_headset_settings->pwm_width)); 792 } 793 accdet_workqueue_func(); 794 while (((pmic_pwrap_read(ACCDET_IRQ_STS) & IRQ_STATUS_BIT) 795 && (accdet_timeout_ns(cur_time, ACCDET_TIME_OUT)))) 796 ; 797 #endif 798 #ifdef ACCDET_NEGV_IRQ 799 cur_time = accdet_get_current_time(); 800 if ((pmic_pwrap_read(ACCDET_IRQ_STS) & NEGV_IRQ_STATUS_BIT) == NEGV_IRQ_STATUS_BIT) { 801 ACCDET_DEBUG("[ACCDET NEGV detect]plug in a error Headset\n\r"); 802 pmic_pwrap_write(ACCDET_IRQ_STS, (IRQ_NEGV_CLR_BIT)); 803 while (((pmic_pwrap_read(ACCDET_IRQ_STS) & NEGV_IRQ_STATUS_BIT) 804 && (accdet_timeout_ns(cur_time, ACCDET_TIME_OUT)))) 805 ; 806 pmic_pwrap_write(ACCDET_IRQ_STS, (pmic_pwrap_read(ACCDET_IRQ_STS) & (~IRQ_NEGV_CLR_BIT))); 807 } 808 #endif 809 810 return 1; 811 }
07-15
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值