【SylixOS之new_1型字符設備驅動設計】

本文介紹new_1型字符設備驅動基本軟件框架,以imx6q的pwm驅動爲例

1、構建設備控制器結構

      定義pwm控制器類型,其中需要注意的是第一個成員必須是LW_DEV_HDR類型,表示設備頭。第二個程序爲LW_LIST_LINE_HEADER類型,用於管理fdnode鏈表。後面可以添加任意與驅動程序有關的私有變量,如寄存器基址等。如程序清單1.1所示。

                                                           程序清單 1.1 pwm控制器結構

/***************************************************************************************
  PWM 控制器類型定義
***************************************************************************************/
typedef struct {
    LW_DEV_HDR                  PWMC_devHdr;            /* 必須是第一個結構體成員       */
    LW_LIST_LINE_HEADER         PWMC_fdNodeHeader;
    addr_t                      PWMC_BaseAddr;
} __IMX6Q_PWM_CONTROLER, *__PIMX6Q_PWM_CONTROLER;

2、構建Open函數

      open函數中主要添加fdnode節點,這也是new_1型字符設備驅動的特點。SylixOS中通過API_IosFdNodeAdd()去添加一個fdnode,並最終返回fdnode。如程序清單2.1所示。

                                                         程序清單 2.1 open函數

/************************************************************************************
** 函數名稱: imx6qPwmOpen
** 功能描述: 打開 PWM 設備
** 輸 入  : pDev                  設備
**           pcName                設備名字
**           iFlags                標誌
**           iMode                 模式
** 輸 出  : 文件節點
** 全局變量:
** 調用模塊:
************************************************************************************/
static LONG  imx6qPwmOpen (__PIMX6Q_PWM_CONTROLER pPwmDev, 
                           PCHAR                  pcName, 
                           INT                    iFlags, 
                           INT                    iMode)
{
    PLW_FD_NODE   pFdNode;
    BOOL          bIsNew;
    addr_t        atBaseAddr;

    if (pcName == LW_NULL) {
        _ErrorHandle(ERROR_IO_NO_DEVICE_NAME_IN_PATH);
        return  (PX_ERROR);

    } else {
        pFdNode = API_IosFdNodeAdd(&pPwmDev->PWMC_fdNodeHeader, (dev_t)pPwmDev, 0,
                                   iFlags, iMode, 0, 0, 0, LW_NULL, &bIsNew);
        if (pFdNode == LW_NULL) {
            printk(KERN_ERR "imx6qWdtOpen(): failed to add fd node!\n");
            return  (PX_ERROR);
        }

        if (LW_DEV_INC_USE_COUNT(&pPwmDev->PWMC_devHdr) == 1) {
            /*
             * 初始化 PWM 定時器,默認設置參數如下
             */
            atBaseAddr = pPwmDev->PWMC_BaseAddr;
            imx6qPwmHwInit(atBaseAddr, 260, 256, 200);
            imx6qPwmEnable(atBaseAddr);

            return  ((LONG)pFdNode);
        }
    }
    /*
     * 如果設備打開失敗進行如下操作
     */
    if (pFdNode) {
        API_IosFdNodeDec(&pPwmDev->PWMC_fdNodeHeader, pFdNode, NULL);
        pFdNode = LW_NULL;
    }

    LW_DEV_DEC_USE_COUNT(&pPwmDev->PWMC_devHdr);
    return  (PX_ERROR);
}

3、構建close、ioctl函數

      close與ioctl函數相對比較簡單。close函數中主要禁用pwm並將打開數減一。ioctl中主要是提供命令修改pwm的相關參數。如程序清單3.1所示。

                                                   程序清單3.1 close、ioctl函數

/************************************************************************************
** 函數名稱: imx6qPwmClose
** 功能描述: 關閉 PWM 設備
** 輸 入  : pFdEntry              文件結構
** 輸 出  : ERROR_CODE
** 全局變量:
** 調用模塊:
************************************************************************************/
static INT imx6qPwmClose (PLW_FD_ENTRY   pFdEntry)
{
    __PIMX6Q_PWM_CONTROLER  pPwmDev  = (__PIMX6Q_PWM_CONTROLER)pFdEntry->FDENTRY_pdevhdrHdr;
    addr_t                  atBaseAddr = pPwmDev->PWMC_BaseAddr;

    imx6qPwmDisable(atBaseAddr);

    LW_DEV_DEC_USE_COUNT(&pPwmDev->PWMC_devHdr);
    return (PX_ERROR);
}
/************************************************************************************
** 函數名稱: imx6qPwmIoctl
** 功能描述: 控制 PWM 設備
** 輸 入  : pFdEntry              文件結構
**           iCmd                  命令
**           lArg                  參數
** 輸 出  : ERROR_CODE
** 全局變量:
** 調用模塊:
************************************************************************************/
static INT  imx6qPwmIoctl (PLW_FD_ENTRY  pFdEntry, INT  iCmd, LONG lArg)
{
    __PIMX6Q_PWM_CONTROLER  pPwmDev = (__PIMX6Q_PWM_CONTROLER)pFdEntry->FDENTRY_pdevhdrHdr;
    addr_t                  atBaseAddr = pPwmDev->PWMC_BaseAddr;
    UINT32                  usRegVal = (UINT32)lArg;

    switch (iCmd) {
    case PWM_FREN:                                  /*  PWM 工作週期                */
        imx6qPwmHwInit(atBaseAddr, usRegVal, 256, 0);
        imx6qPwmEnable(atBaseAddr);
        return  (ERROR_NONE);
    case PWM_DUTY:                                  /*  設置佔空比                  */
        imx6qPwmHwInit(atBaseAddr, 0, 256, usRegVal);
        imx6qPwmEnable(atBaseAddr);
        return  (ERROR_NONE);
    default:
        return  (PX_ERROR);
    }
}

4、構建驅動安裝函數

      驅動安裝函數主要目的是將驅動註冊到系統中。首先需要構建file_operations結構存放open、close、ioctl等操作,再使用結構iosDrvInstallEx2()將此結構註冊到系統中,並獲取對應的驅動編號,供設備安裝時使用。如程序清單4.1所示。

                                              程序清單4.1 安裝驅動

/************************************************************************************
** 函數名稱: imx6qPwmDrv
** 功能描述: 安裝 PWM 驅動
** 輸 入  : NONE
** 輸 出  : ERROR_CODE
** 全局變量:
** 調用模塊:
************************************************************************************/
INT  imx6qPwmDrv (VOID)
{
    struct file_operations  fileop;

    if (_G_iPwmDrvNum) {
        return  (ERROR_NONE);
    }

    lib_memset(&fileop, 0, sizeof(struct file_operations));

    fileop.owner     = THIS_MODULE;
    fileop.fo_create = imx6qPwmOpen;
    fileop.fo_open   = imx6qPwmOpen;
    fileop.fo_close  = imx6qPwmClose;
    fileop.fo_ioctl  = imx6qPwmIoctl;
    fileop.fo_write  = imx6qPwmWrite;
    fileop.fo_read   = imx6qPwmRead;

    _G_iPwmDrvNum = iosDrvInstallEx2(&fileop, LW_DRV_TYPE_NEW_1);

    DRIVER_LICENSE(_G_iPwmDrvNum,     "Dual BSD/GPL->Ver 1.0");
    DRIVER_AUTHOR(_G_iPwmDrvNum,      "Zhang.Xu");
    DRIVER_DESCRIPTION(_G_iPwmDrvNum, "PWM driver.");

    return  (_G_iPwmDrvNum > 0) ? (ERROR_NONE) : (PX_ERROR);
}

5、創建PWM設備

      創建pwm設備函數主要是通過API_IosDevAddEx()創建設備文件節點,並綁定對應的驅動編碼即上一節中生成的驅動編號。這使得上層應用在打開此設備文件節點時可以獲取對應的驅動編碼,然後找到對應的驅動程序。如程序清單5.1所示。

                                                        程序清單 5.1 創建pwm設備

/************************************************************************************
** 函數名稱: imx6qPwmDevAdd
** 功能描述: 創建 PWM 設備
** 輸 入  : uiIndex           ID
** 輸 出  : ERROR_CODE
** 全局變量:
** 調用模塊:
************************************************************************************/
INT  imx6qPwmDevAdd (UINT  uiIndex)
{
	__PIMX6Q_PWM_CONTROLER   pPwmDev;
	CPCHAR                   pcBuffer;

    if (uiIndex >= PWM_NUM) {
        printk(KERN_ERR "imx6qWdtDevAdd(): wdt index invalid!\n");
        return  (PX_ERROR);
    }
    pPwmDev = &_G_pwm[uiIndex];

    switch (uiIndex) {
    case 0:
    	pcBuffer = "/dev/pwm0";
        pPwmDev ->PWMC_BaseAddr = PWM1_BASE_ADDR;
        pwm1_iomux_config();
        break;

    case 1:
    	pcBuffer = "/dev/pwm1";
        pPwmDev ->PWMC_BaseAddr = PWM2_BASE_ADDR;
        pwm2_iomux_config();
        break;

    case 2:
    	pcBuffer = "/dev/pwm2";
        pPwmDev ->PWMC_BaseAddr = PWM3_BASE_ADDR;
        pwm3_iomux_config();
        break;

    case 3:
    	pcBuffer = "/dev/pwm3";
        pPwmDev ->PWMC_BaseAddr = PWM4_BASE_ADDR;
        pwm4_iomux_config();
        break;
    }

    if (API_IosDevAddEx(&pPwmDev->PWMC_devHdr, 
                         pcBuffer, 
                         _G_iPwmDrvNum, 
                         DT_CHR) != ERROR_NONE) {
        printk(KERN_ERR "imx6qWdtDevAdd(): can not add device : %s.\n", strerror(errno));
        return  (PX_ERROR);
    }
    return  (ERROR_NONE);
}

6、調用接口

      最後一步就是調用驅動安裝和設備創建這兩個函數接口。一般情況下驅動安裝在bspInit.c中的halDrvInit()中被調用,而設備創建在bspInit.c的halDevInit()中被調用。

 

 

 

 

發表評論
所有評論
還沒有人評論,想成為第一個評論的人麼? 請在上方評論欄輸入並且點擊發布.
相關文章