微波EDA网，见证研发工程师的成长！
首页 > 研发问答 > 手机设计讨论 > MTK手机平台交流 > 求助闪光灯不亮

求助闪光灯不亮

时间：10-02 整理：3721RD 点击：
如题。MT6582  kk版本，闪光灯不亮，通过log分析，下面这个函数跑的流程是default，请问遇到的同仁是什么原因导致上层传的参数不对?万分感谢！
static int constant_flashlight_ioctl(MUINT32 cmd, MUINT32 arg)
{
int i4RetValue = 0;
int ior_shift;
int iow_shift;
int iowr_shift;
ior_shift = cmd - (_IOR(FLASHLIGHT_MAGIC,0, int));
iow_shift = cmd - (_IOW(FLASHLIGHT_MAGIC,0, int));
iowr_shift = cmd - (_IOWR(FLASHLIGHT_MAGIC,0, int));
printk("swordking in 82 %s  @%d cmd = %d\n",__func__,__LINE__,cmd);
PK_DBG("constant_flashlight_ioctl() line=%d ior_shift=%d, iow_shift=%d iowr_shift=%d arg=%d\n",__LINE__, ior_shift, iow_shift, iowr_shift, arg);
    switch(cmd)
    {
  case FLASH_IOC_SET_TIME_OUT_TIME_MS:
    printk("swordking in 82 %s  %d\n",__func__,__LINE__);
   PK_DBG("FLASH_IOC_SET_TIME_OUT_TIME_MS: %d\n",arg);
   g_timeOutTimEMS=arg;
  break;
     case FLASH_IOC_SET_DUTY :
    printk("swordking in 82 %s  %d\n",__func__,__LINE__);
      PK_DBG("FLASHLIGHT_DUTY: %d\n",arg);
      FL_dim_duty(arg);
      break;
     case FLASH_IOC_SET_STEP:
    printk("swordking in 82 %s  %d\n",__func__,__LINE__);
      PK_DBG("FLASH_IOC_SET_STEP: %d\n",arg);
      break;
     case FLASH_IOC_SET_ONOFF :
    printk("swordking in 82 %s  %d\n",__func__,__LINE__);
      PK_DBG("FLASHLIGHT_ONOFF: %d\n",arg);
      if(arg==1)
      {
       printk("swordking in 82 %s  %d\n",__func__,__LINE__);
    if(g_timeOutTimeMs！=0)
             {
              ktime_t ktime;
      printk("swordking in 82 %s  %d\n",__func__,__LINE__);
     ktime = ktime_set( 0, g_timeOutTimeMs*1000000 );
     hrtimer_start( &g_timeOutTimer, ktime, HRTIMER_MODE_REL );
             }
       FL_Enable();
      }
      else
      {
       printk("swordking in 82 %s  %d\n",__func__,__LINE__);
       FL_Disable();
    hrtimer_cancel( &g_timeOutTimer );
      }
      break;
  default :
    printk("swordking in 82 %s  %d\n",__func__,__LINE__);
      PK_DBG(" No such command \n");
      i4RetValue = -EPERM;
      break;
    }

我也遇到这个问题了，您遇到这个问题已经过了将近一年了，想必早已解决了吧，可以帮忙回答我一下吗?万分感谢！

驱动发给我看下

  1. #include <linux/kernel.h>
  2. #include <linux/module.h>
  3. #include <linux/init.h>
  4. #include <linux/types.h>
  5. #include <linux/wait.h>
  6. #include <linux/slab.h>
  7. #include <linux/fs.h>
  8. #include <linux/sched.h>
  9. #include <linux/poll.h>
  10. #include <linux/device.h>
  11. #include <linux/interrupt.h>
  12. #include <linux/delay.h>
  13. #include <linux/platform_device.h>
  14. #include <linux/cdev.h>
  15. #include <linux/errno.h>
  16. #include <linux/time.h>
  17. #include "kd_flashlight.h"
  18. #include <asm/io.h>
  19. #include <asm/uaccess.h>
  20. #include "kd_camera_hw.h"
  21. #include <linux/hrtimer.h>
  22. #include <linux/ktime.h>
  23. #include <linux/xlog.h>
  24. #include <mach/upmu_common.h>

  26. #include <mach/mt_gpio.h>                // For gpio control

  28. /******************************************************************************
  29. * Debug configuration
  30. ******************************************************************************/
  31. // availible parameter
  32. // ANDROID_LOG_ASSERT
  33. // ANDROID_LOG_ERROR
  34. // ANDROID_LOG_WARNING
  35. // ANDROID_LOG_INFO
  36. // ANDROID_LOG_DEBUG
  37. // ANDROID_LOG_VERBOSE
  38. #define TAG_NAME "leds_strobe.c"
  39. #define PK_DBG_NONE(fmt, arg...)    do {} while (0)
  40. #define PK_DBG_FUNC(fmt, arg...)    xlog_printk(ANDROID_LOG_DEBUG  , TAG_NAME, KERN_INFO  "%s: " fmt, __FUNCTION__ ,##arg)
  41. #define PK_WARN(fmt, arg...)        xlog_printk(ANDROID_LOG_WARNING, TAG_NAME, KERN_WARNING  "%s: " fmt, __FUNCTION__ ,##arg)
  42. #define PK_NOTICE(fmt, arg...)      xlog_printk(ANDROID_LOG_DEBUG  , TAG_NAME, KERN_NOTICE  "%s: " fmt, __FUNCTION__ ,##arg)
  43. #define PK_INFO(fmt, arg...)        xlog_printk(ANDROID_LOG_INFO   , TAG_NAME, KERN_INFO  "%s: " fmt, __FUNCTION__ ,##arg)
  44. #define PK_TRC_FUNC(f)              xlog_printk(ANDROID_LOG_DEBUG  , TAG_NAME,  "<%s>\n", __FUNCTION__);
  45. #define PK_TRC_VERBOSE(fmt, arg...) xlog_printk(ANDROID_LOG_VERBOSE, TAG_NAME,  fmt, ##arg)
  46. #define PK_ERROR(fmt, arg...)       xlog_printk(ANDROID_LOG_ERROR  , TAG_NAME, KERN_ERR "%s: " fmt, __FUNCTION__ ,##arg)


  49. #define DEBUG_LEDS_STROBE
  50. #ifdef  DEBUG_LEDS_STROBE
  51.         #define PK_DBG PK_DBG_FUNC
  52.         #define PK_VER PK_TRC_VERBOSE
  53.         #define PK_ERR PK_ERROR
  54. #else
  55.         #define PK_DBG(a,...)
  56.         #define PK_VER(a,...)
  57.         #define PK_ERR(a,...)
  58. #endif

  60. /******************************************************************************
  61. * local variables
  62. ******************************************************************************/
  63. static DEFINE_SPINLOCK(g_strobeSMPLock);
  64. static u32 strobe_Res = 0;
  65. static BOOL g_strobe_On = 0;
  66. static int g_duty=-1;
  67. static int g_step=-1;
  68. static int g_timeOutTimeMs=0;

  70. static struct work_struct workTimeOut;
  71. /*****************************************************************************
  72. Functions
  73. *****************************************************************************/
  74. static void work_timeOutFunc(struct work_struct *data);

  76. #define LEDS_TORCH_MODE                 0
  77. #define LEDS_FLASH_MODE                 1
  78. #define LEDS_CUSTOM_MODE_THRES         20

  80. #ifndef GPIO_CAMERA_FLASH_EN_PIN
  81. #define GPIO_CAMERA_FLASH_EN_PIN GPIO24
  82. #endif

  84. #ifndef GPIO_CAMERA_FLASH_EN_PIN_M_GPIO
  85. #define GPIO_CAMERA_FLASH_EN_PIN_M_GPIO GPIO_MODE_00
  86. #endif

  88. #ifndef GPIO_CAMERA_FLASH_MODE_PIN
  89. #define GPIO_CAMERA_FLASH_MODE_PIN GPIO25
  90. #endif

  92. #ifndef GPIO_CAMERA_FLASH_MODE_PIN_M_GPIO
  93. #define GPIO_CAMERA_FLASH_MODE_PIN_M_GPIO GPIO_MODE_00
  94. #endif

  96. int FL_enable(void)
  97. {
  98.         PK_DBG("FL_enable");
  99.         mt_set_gpio_out(GPIO_CAMERA_FLASH_EN_PIN, 1);

  101. //        upmu_set_rg_bst_drv_1m_ck_pdn(0);
  102. //        upmu_set_flash_en(1);
  103.     return 0;
  104. }

  106. int FL_disable(void)
  107. {
  108.         PK_DBG("FL_disable");
  109.         mt_set_gpio_out(GPIO_CAMERA_FLASH_EN_PIN, 0);
  110. //        upmu_set_flash_en(0);
  111.         //upmu_set_rg_bst_drv_1m_ck_pdn(1);
  112.     return 0;
  113. }

  115. int FL_dim_duty(kal_uint32 duty)
  116. {
  117.         PK_DBG("FL_dim_duty %d, thres %d", duty, LEDS_CUSTOM_MODE_THRES);

  119.         if(duty < LEDS_CUSTOM_MODE_THRES)
  120.                 mt_set_gpio_out(GPIO_CAMERA_FLASH_MODE_PIN, LEDS_TORCH_MODE);
  121.         else
  122.                 mt_set_gpio_out(GPIO_CAMERA_FLASH_MODE_PIN, LEDS_FLASH_MODE);

  124.         if((g_timeOutTimeMs == 0) && (duty > LEDS_CUSTOM_MODE_THRES))
  125.         {
  126.                 PK_ERR("FL_dim_duty %d > thres %d, FLASH mode but timeout %d", duty, LEDS_CUSTOM_MODE_THRES, g_timeOutTimeMs);
  127.                 mt_set_gpio_out(GPIO_CAMERA_FLASH_MODE_PIN, LEDS_TORCH_MODE);
  128.         }
  129. //        upmu_set_flash_dim_duty(duty);
  130.     return 0;
  131. }

  133. int FL_step(kal_uint32 step)
  134. {
  135.         //int sTab[8]={0,2,4,6,9,11,13,15};
  136.         PK_DBG("FL_step");
  137. //        upmu_set_flash_sel(sTab[step]);
  138.     return 0;
  139. }

  141. int FL_init(void)
  142. {
  143. //        upmu_set_flash_dim_duty(0);
  144. //        upmu_set_flash_sel(0);
  145.         PK_DBG("FL_init");

  147.         mt_set_gpio_mode(GPIO_CAMERA_FLASH_EN_PIN, GPIO_CAMERA_FLASH_EN_PIN_M_GPIO);
  148.         mt_set_gpio_mode(GPIO_CAMERA_FLASH_MODE_PIN, GPIO_CAMERA_FLASH_MODE_PIN_M_GPIO);

  150.         //FL_disable();
  151.         FL_enable();
  152.         INIT_WORK(&workTimeOut, work_timeOutFunc);
  153.     return 0;
  154. }

  156. int FL_uninit(void)
  157. {
  158.         PK_DBG("FL_uninit");

  160.         FL_disable();
  161.     return 0;
  162. }

  164. /*****************************************************************************
  165. User interface
  166. *****************************************************************************/
  167. static void work_timeOutFunc(struct work_struct *data)
  168. {
  169.         FL_disable();
  170.     PK_DBG("ledTimeOut_callback\n");
  171.     //printk(KERN_ALERT "work handler function./n");
  172. }
  173. enum hrtimer_restart ledTimeOutCallback(struct hrtimer *timer)
  174. {
  175.         PK_DBG("ledTimeOut_callback\n");
  176.         schedule_work(&workTimeOut);

  178.     return HRTIMER_NORESTART;
  179. }
  180. static struct hrtimer g_timeOutTimer;
  181. void timerInit(void)
  182. {
  183.         g_timeOutTimeMs=1000; //1s
  184.         hrtimer_init( &g_timeOutTimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL );
  185.         g_timeOutTimer.function=ledTimeOutCallback;

  187. }

  189. static int constant_flashlight_ioctl(MUINT32 cmd, MUINT32 arg)
  190. {
  191.         int i4RetValue = 0;
  192.         int iFlashType = (int)FLASHLIGHT_NONE;
  193.         int ior;
  194.         int iow;
  195.         int iowr;
  196.         ior = _IOR(FLASHLIGHT_MAGIC,0, int);
  197.         iow = _IOW(FLASHLIGHT_MAGIC,0, int);
  198.         iowr = _IOWR(FLASHLIGHT_MAGIC,0, int);
  199.         PK_DBG("constant_flashlight_ioctl() line=%x cmd=%x, ior=%x, iow=%x iowr=%x arg=%x\n",__LINE__, cmd, ior, iow, iowr, arg);
  200.         //PK_DBG("constant_flashlight_ioctl() line=%x cmd-ior=%x, cmd-iow=%x cmd-iowr=%x arg=%x\n",__LINE__, cmd-ior, cmd-iow, cmd-iowr, arg);
  201.         PK_DBG("constant_flashlight_ioctl() line=%d cmd=%d, ior=%d, iow=%d iowr=%d arg=%d\n",__LINE__, cmd, ior, iow, iowr, arg);
  202.         PK_DBG("constant_flashlight_ioctl() line=%d cmd-ior=%d, cmd-iow=%d cmd-iowr=%d arg=%d\n",__LINE__, cmd-ior, cmd-iow, cmd-iowr, arg);
  203.         PK_DBG("constant_flashlight_ioctl() FLASH_IOC_SET_TIME_OUT_TIME_MS=%x FLASH_IOC_SET_DUTY=%x, FLASH_IOC_SET_STEP=%x, FLASH_IOC_SET_ONOFF=%x FLASHLIGHTIOC_G_FLASHTYPE=%x arg=%x\n",FLASH_IOC_SET_TIME_OUT_TIME_MS, FLASH_IOC_SET_DUTY, FLASH_IOC_SET_STEP, FLASH_IOC_SET_ONOFF, FLASHLIGHTIOC_G_FLASHTYPE, arg);
  204.        
  205.     switch(cmd)
  206.     {

  208.                 case FLASH_IOC_SET_TIME_OUT_TIME_MS:
  209.                         PK_DBG("FLASH_IOC_SET_TIME_OUT_TIME_MS: %d\n",arg);
  210.                         g_timeOutTimeMs=arg;
  211.                         break;

  213.             case FLASH_IOC_SET_DUTY :
  214.                     PK_DBG("FLASHLIGHT_DUTY: %d\n",arg);
  215.                     g_duty=arg;
  216.                     FL_dim_duty(arg);
  217.                     break;

  219.             case FLASH_IOC_SET_STEP:
  220.                     PK_DBG("FLASH_IOC_SET_STEP: %d\n",arg);
  221.                     g_step=arg;
  222.                     FL_step(arg);
  223.                     break;

  225.             case FLASH_IOC_SET_ONOFF :
  226.                     PK_DBG("FLASHLIGHT_ONOFF: %d\n",arg);
  227.                     if(arg==1)
  228.                     {
  229.                                 if(g_timeOutTimeMs！=0)
  230.                     {
  231.                             ktime_t ktime;
  232.                                         ktime = ktime_set( 0, g_timeOutTimeMs*1000000 );
  233.                                         hrtimer_start( &g_timeOutTimer, ktime, HRTIMER_MODE_REL );
  234.                     }
  235.                             FL_enable();
  236.                             g_strobe_On=1;
  237.                     }
  238.                     else
  239.                     {
  240.                             FL_disable();
  241.                                 hrtimer_cancel( &g_timeOutTimer );
  242.                                 g_strobe_On=0;
  243.                     }
  244.                     break;
  245.         case FLASHLIGHTIOC_G_FLASHTYPE:
  246.             iFlashType = FLASHLIGHT_LED_CONSTANT;
  247.             if(copy_to_user((void __user *) arg , (void*)&iFlashType , _IOC_SIZE(cmd)))
  248.             {
  249.                 PK_DBG("[strobe_ioctl] ioctl copy to user failed\n");
  250.                 return -EFAULT;
  251.             }
  252.             break;
  253.                 default :
  254.                     PK_DBG(" No such command \n");
  255.                     i4RetValue = -EPERM;
  256.                     break;
  257.     }
  258.     return i4RetValue;
  259. }

  261. static int constant_flashlight_open(void *pArg)
  262. {
  263.     int i4RetValue = 0;
  264.     PK_DBG("constant_flashlight_open line=%d\n", __LINE__);

  266.         if (0 == strobe_Res)
  267.         {
  268.             FL_init();
  269.                 timerInit();
  270.         }
  271.         spin_lock_irq(&g_strobeSMPLock);

  273.     if(strobe_Res)
  274.     {
  275.         PK_ERR(" busy！\n");
  276.         i4RetValue = -EBUSY;
  277.     }
  278.     else
  279.     {
  280.         strobe_Res += 1;
  281.     }

  283.     spin_unlock_irq(&g_strobeSMPLock);

  285.     return i4RetValue;

  287. }

  289. static int constant_flashlight_release(void *pArg)
  290. {
  291.     PK_DBG(" constant_flashlight_release\n");

  293.     if (strobe_Res)
  294.     {
  295.         spin_lock_irq(&g_strobeSMPLock);

  297.         strobe_Res = 0;

  299.         /* LED On Status */
  300.         g_strobe_On = FALSE;

  302.         spin_unlock_irq(&g_strobeSMPLock);

  304.             FL_uninit();
  305.     }

  307.     PK_DBG(" Done\n");

  309.     return 0;

  311. }

  313. FLASHLIGHT_FUNCTION_STRUCT        constantFlashlightFunc=
  314. {
  315.         constant_flashlight_open,
  316.         constant_flashlight_release,
  317.         constant_flashlight_ioctl
  318. };

  320. MUINT32 constantFlashlightInit(PFLASHLIGHT_FUNCTION_STRUCT *pfFunc)
  321. {
  322.     if (pfFunc ！= NULL)
  323.     {
  324.         *pfFunc = &constantFlashlightFunc;
  325.     }
  326.     return 0;
  327. }

  329. /* LED flash control for high current capture mode*/
  330. ssize_t strobe_VDIrq(void)
  331. {

  333.     return 0;
  334. }

  336. EXPORT_SYMBOL(strobe_VDIrq);

复制代码

case FLASHLIGHTIOC_G_FLASHTYPE
1、ioctl的这个case跑到没?
2、需要确认闪光灯是不是好的?

上一篇：求助 如何注册获得MTK官网帐号
下一篇：求个 Memory LCD(LS013B7DH03) 61平台用的驱动

ant EMS 相关文章：

栏目分类
热门文章

Copyright © 2017-2020 微波EDA网 版权所有

网站地图

Top