系统处理 IRQ_EINT0 IRQ_EIN…

本文详细解析了S3C2440处理器在处理IRQ_EINT0 IRQ_EINT11中断时的过程,从中断向量存放位置到中断处理的全局流程,包括主中断和次中断的识别、中断号的获取以及如何调用相应的中断处理函数。重点阐述了中断寄存器的使用、中断识别宏get_irqnr_and_base的作用以及中断处理路径的实现细节。

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

系统处理 IRQ_EINT0 IRQ_EINT11 的过程 主要分析系统处理 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)


#define IRQ_EINT0          S3C2410_IRQ(0)             
#define IRQ_EINT1          S3C2410_IRQ(1)
#define IRQ_EINT2          S3C2410_IRQ(2)
#define IRQ_EINT3          S3C2410_IRQ(3)
#define IRQ_EINT4t7      S3C2410_IRQ(4)             
#define IRQ_EINT8t23    S3C2410_IRQ(5)
#define IRQ_RESERVED6  S3C2410_IRQ(6)             
#define IRQ_CAM              S3C2410_IRQ(6)             
#define IRQ_BATT_FLT    S3C2410_IRQ(7)
#define IRQ_TICK            S3C2410_IRQ(8)             
#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)             
#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)             
#define IRQ_NFCON          S3C2410_IRQ(24)             
#define IRQ_USBD            S3C2410_IRQ(25)
#define IRQ_USBH            S3C2410_IRQ(26)
#define IRQ_IIC                    S3C2410_IRQ(27)
#define IRQ_UART0          S3C2410_IRQ(28)             
#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个中断源之一。次中断组织如下。


#define IRQ_EINT4          S3C2410_IRQ(32)           
#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)           
#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)


#define IRQ_S3CUART_RX0  S3C2410_IRQ(54)   
#define IRQ_S3CUART_TX0  S3C2410_IRQ(55)   
#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)



#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
          vector_und + stubs_offset
      ldr      pc, .LCvswi + stubs_offset
          vector_pabt + stubs_offset
          vector_dabt + stubs_offset
          vector_addrexcptn + stubs_offset
          vector_irq + stubs_offset
          vector_fiq + stubs_offset

      .globl      __vectors_end
__vectors_end:

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


.globl      __stubs_start
__stubs_start:

      vector_stub      irq, 4

      .long      __irq_usr                      (USR_26 / USR_32)
      .long      __irq_invalid                      (FIQ_26 / FIQ_32)
      .long      __irq_invalid                      (IRQ_26 / IRQ_32)
      .long      __irq_svc                      (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

      ...

          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:有。

             
#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
                  20004f

20003:
              .ascii      "<7>irq: err - bad offset %d, intpnd=x, srcpnd=xn"
              .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
                  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
                  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()




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

      irqdbf("s3c2410_init_irq: clearing interrupt status flagsn");

     

      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 xn", (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 xn", (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 xn", (int)pend);
              __raw_writel(pend, S3C2410_SUBSRCPND);
              last = pend;
      }

     

      irqdbf("s3c2410_init_irq: registering s3c2410 interrupt handlersn");

      for (irqno = IRQ_BATT_FLT; irqno <= IRQ_ADCPARENT; irqno++) {
             

              switch (irqno) {
                     

              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:
                     
                      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);
              }
      }

     
//这里就是可以识别的级联的次中断所在的主中断号。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);


     

      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);
      }

     

      irqdbf("s3c2410: registering external interruptsn");

      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 handlersn");
}

可以发现,这里没有安装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) {
                     

              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 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
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值