diff --git a/ac101.c b/ac101.c index 6c7d71d..6d3e8eb 100644 --- a/ac101.c +++ b/ac101.c @@ -105,13 +105,6 @@ int ac101_update_bits(struct snd_soc_codec *codec, unsigned reg, #define KEY_HEADSETHOOK 226 /* key define */ #define HEADSET_FILTER_CNT (10) -#define _AC101_CREATE_QUEUE 0 - -#if _AC101_CREATE_QUEUE -static struct workqueue_struct *queue_switch_detect; -static struct workqueue_struct *queue_codec_irq; -#endif - /* * switch_hw_config:config the 53 codec register */ @@ -199,11 +192,7 @@ static void work_cb_clear_irq(struct work_struct *work) ac10x->irq_cntr--; } - #if _AC101_CREATE_QUEUE - if (0 == queue_work(queue_switch_detect, &ac10x->work_switch)) { - #else if (0 == schedule_work(&ac10x->work_switch)) { - #endif ac10x->irq_cntr--; AC101_DBG("[work_cb_clear_irq] add work struct failed!\n"); } @@ -218,7 +207,9 @@ enum { }; static int __ac101_get_hmic_data(struct snd_soc_codec *codec) { + #ifdef AC101_DEBG static long counter; + #endif int r; int d; @@ -315,7 +306,7 @@ static void work_cb_earphone_switch(struct work_struct *work) } } } else { - while (ac10x->irq_cntr == 0) { + while (ac10x->irq_cntr == 0 && ac10x->irq != 0) { msleep(20); t = __ac101_get_hmic_data(codec); @@ -357,17 +348,7 @@ static irqreturn_t audio_hmic_irq(int irq, void *para) return -EINVAL; } - #if _AC101_CREATE_QUEUE - if (queue_codec_irq == NULL) { - AC101_DBG("------------queue_codec_irq is null !!----------"); - return IRQ_NONE; - } - if (0 == queue_work(queue_codec_irq, &ac10x->work_clear_irq)){ - - #else if (0 == schedule_work(&ac10x->work_clear_irq)){ - #endif - AC101_DBG("[audio_hmic_irq] work already in queue_codec_irq, adding failed!\n"); } return IRQ_HANDLED; @@ -437,27 +418,10 @@ static int ac101_switch_probe(struct ac10x_priv *ac10x) { /* the first headset state checking */ switch_hw_config(ac10x->codec); ac10x->irq_cntr = 1; - #if _AC101_CREATE_QUEUE - queue_codec_irq = create_singlethread_workqueue("codec_irq"); - queue_switch_detect = create_singlethread_workqueue("codec_switch"); - if (queue_switch_detect == NULL || queue_codec_irq == NULL) { - AC101_DBG("try to create workqueue for codec failed!\n"); - ret = -ENOMEM; - goto _err_switch_work_queue; - } - - queue_work(queue_switch_detect, &ac10x->work_switch); - #else schedule_work(&ac10x->work_switch); - #endif return 0; -#if _AC101_CREATE_QUEUE -_err_switch_work_queue: - - input_unregister_device(ac10x->inpdev); -#endif _err_input_register_device: _err_input_allocate_device: @@ -1479,6 +1443,9 @@ int ac101_codec_remove(struct snd_soc_codec *codec) /* devm_free_irq(codec->dev, ac10x->irq, NULL); */ ac10x->irq = 0; } + + if (cancel_work_sync(&ac10x->work_switch) != 0) { + } #endif return 0;