pwm.c

周立功 开发包 ARM9

/****************************************Copyright (c)**************************************************
**                               Guangzhou ZHIYUAN electronics Co.,LTD.
**                                     
**                                 http://www.zyinside.com
**
**--------------File Info-------------------------------------------------------------------------------
** File Name: 				pwm.c
** Last modified Date: 		2006-10-09
** Last Version:			V1.0		
** Description: 			S3C2410 PWM 驱动
**                          This driver uses PWM with Timer0 or Timer1, the ouput is TOUT0 or TOUT1
**------------------------------------------------------------------------------------------------------
** Created By: 				MingYuan Zheng 郑明远
** Created date: 			2006-10-09
** Version: 				V1.0
** Descriptions:			The original version
**
**------------------------------------------------------------------------------------------------------
** Modified by:
** Modified date:
** Version:
** Description:
**
********************************************************************************************************/


#include <windows.h>
#include <types.h>
#include <excpt.h>
#include <tchar.h>
#include <cardserv.h>
#include <cardapi.h>
#include <tuple.h>
#include <devload.h>
#include <diskio.h>
#include <nkintr.h>
#include <windev.h>

#include <s3c2410x.h>
#include "pwm.h"

#define PRIVATE			static
#define PUBLIC


/* GPIO,PWM 寄存器对应的虚拟地址 */
PRIVATE volatile S3C2410X_IOPORT_REG * v_pIOPregs;
PRIVATE volatile S3C2410X_PWM_REG * v_PWMregs;

PRIVATE DWORD  m_s3c2410_pclk;
PRIVATE DWORD  g_OpenCount = 0;

#define DEFAULT_S3C2410X_PCLK (203000000 / 4)

/*******************************************************************************************
函数名称: PWM_ConfigPin
描    述: 初始化 GPB0 为 TOUT0 功能
输入参数: DWORD t_num: 定时器编号: 0 或 1	
输出参数: 无
返    回: 无
********************************************************************************************/
PRIVATE void PWM_ConfigPin(DWORD t_num)
{
    if (t_num == 0)
    {
        // TOUT0口设置
        v_pIOPregs->GPBCON &= ~(0x03 << 0);
	    v_pIOPregs->GPBCON |=  (0x02 << 0);     // rGPBCON[1:0] = 10b，设置TOUT0功能    
        v_pIOPregs->GPBUP |= 0x1 << 0;                    
    }
    else if (t_num == 1)
    {
        // TOUT1口设置
        v_pIOPregs->GPBCON &= ~(0x03 << 2);
	    v_pIOPregs->GPBCON |=  (0x02 << 1);     // rGPBCON[3:2] = 10b，设置TOUT1功能    
        v_pIOPregs->GPBUP |= 0x1 << 1;                
     }
}


/*******************************************************************************************
函数名称: PWM_ConfigPWMDefault
描    述: 恢复 PWM0 和 PWM1 的硬件为默认值
输入参数: DWORD t_num: 定时器编号: 0 或 1	
输出参数: 无
返    回: 无
********************************************************************************************/
PRIVATE void PWM_ConfigPWMDefault(DWORD t_num)
{
	if (t_num == 0)
	{
		// TOUT0口设置
		v_pIOPregs->GPBCON &= ~(0x03 << 0);		 // rGPBCON[1:0] = 00b，设置GPB0 为输入GPIO
		v_pIOPregs->GPBUP &= ~(0x1 << 0);        // 上拉 
		
		v_PWMregs->TCFG0 &= ~0xFF;				 // Timer0 预分频恢复为0
		v_PWMregs->TCFG1 &= ~0x0F;				 // MUX0

		v_PWMregs->TCON &= ~0x1F;				 // Timer0 TCON 
		v_PWMregs->TCNTB0 = 0; 					 // 定时值(PWM周期)       
        v_PWMregs->TCMPB0 = 0;				 	 // 设置PWM占空比
	}

	if (t_num == 1)
	{
		// TOUT1口设置
		v_pIOPregs->GPBCON &= ~(0x03 << 2);		 // rGPBCON[1:0] = 00b，设置GPB1 为输入GPIO
		v_pIOPregs->GPBUP &= ~(0x1 << 1);        // 上拉    

		v_PWMregs->TCFG0 &= ~0xFF;				 // Timer1 预分频恢复为0
		v_PWMregs->TCFG1 &= ~(0x0F << 4);		 // MUX1

		v_PWMregs->TCON &= ~(0xF << 8);			 // Timer1 TCON 
		v_PWMregs->TCNTB1 = 0; 					 // 定时值(PWM周期)       
        v_PWMregs->TCMPB1 = 0;				 	 // 设置PWM占空比	
	}

}	


/*******************************************************************************************
函数名称: PWM_InitializeAddresses
描    述: 取得相关寄存器的虚拟地址
输入参数: 无	
输出参数: 无
返    回: > 0 分配到的虚拟地址;  FALSE: 失败  
********************************************************************************************/
PRIVATE BOOL PWM_InitializeAddresses(void)
{
	BOOL RetValue = TRUE;

	//	IO Register Allocation
	v_pIOPregs = (volatile S3C2410X_IOPORT_REG *)VirtualAlloc(0, sizeof(S3C2410X_IOPORT_REG), MEM_RESERVE, PAGE_NOACCESS);
	if (v_pIOPregs == NULL) 
	{
		ERRORMSG(1,(TEXT("For IOPregs : VirtualAlloc failed!\r\n")));
		RetValue = FALSE;
	}
	else 
	{
		if (!VirtualCopy((PVOID)v_pIOPregs, (PVOID)(S3C2410X_BASE_REG_PA_IOPORT >> 8), sizeof(S3C2410X_IOPORT_REG), PAGE_PHYSICAL | PAGE_READWRITE | PAGE_NOCACHE)) 
		{
			ERRORMSG(1,(TEXT("For IOPregs: VirtualCopy failed!\r\n")));
			RetValue = FALSE;
		}
	}
	
	if (!RetValue) 
	{
		RETAILMSG (1, (TEXT("::: PWM_InitializeAddresses - Fail!!\r\n") ));

		if (v_pIOPregs) 
			VirtualFree((PVOID) v_pIOPregs, 0, MEM_RELEASE);

		v_pIOPregs = NULL;
		RetValue = FALSE;
		return RetValue;
	}

	// 
	//	PWM Register Allocation
	//
	v_PWMregs = (volatile S3C2410X_PWM_REG *)VirtualAlloc(0, sizeof(S3C2410X_PWM_REG), MEM_RESERVE, PAGE_NOACCESS);
	if (v_PWMregs == NULL) 
	{
		ERRORMSG(1,(TEXT("For PWMregs : VirtualAlloc failed!\r\n")));
		RetValue = FALSE;
	}
	else 
	{
		if (!VirtualCopy((PVOID)v_PWMregs, (PVOID)(S3C2410X_BASE_REG_PA_PWM >> 8), sizeof(S3C2410X_PWM_REG), PAGE_PHYSICAL | PAGE_READWRITE | PAGE_NOCACHE)) 
		{
			ERRORMSG(1,(TEXT("For PWMregs: VirtualCopy failed!\r\n")));
			RetValue = FALSE;
		}
	}
	
	if (!RetValue) 
	{
		RETAILMSG (1, (TEXT("::: PWM_InitializeAddresses - Fail!!\r\n") ));

		if (v_PWMregs) 
			VirtualFree((PVOID) v_PWMregs, 0, MEM_RELEASE);

		v_PWMregs = NULL;
	}
	
	return(RetValue);
}

/*******************************************************************************************
函数名称: PWM_SetPrescaler
描    述: 设置定时器 0 和 1 的预分频值
输入参数: BYTE t_num: 定时器编号: 0 或 1
          BYTE value: 预分频值, 值从 0 ~ 255
输出参数: 无
返    回: 无
********************************************************************************************/
void PWM_SetPrescaler(BYTE t_num, BYTE value)
{
    if ((t_num == 0) || (t_num == 1))
    {
    	v_PWMregs->TCFG0 &= ~0xFF;
        v_PWMregs->TCFG0 |= value;		    // 设置定时器 0,1 的预分频值  
    }
}

/*******************************************************************************************
函数名称: PWM_SetDivider
描    述: 设置定时器 0 和 1 的分频器分频值
输入参数: BYTE t_num: 定时器编号: 0 或 1
          BYTE value: 分频值: 2,4,8,16
输出参数: 无
返    回: TRUE: 成功;  FALSE: 失败
********************************************************************************************/
BOOL PWM_SetDivider(BYTE t_num, BYTE value)
{
    BYTE tmp;
    
    if ((t_num > 1) || (value > 16))    
        return FALSE;
   
	for (tmp = 0; tmp < 4; tmp++)
    {
        if ((2 << tmp) == value)
            break;
    }   
    
    if (tmp > 4)                    
        return FALSE;                               // value 取值只能为 2,4,8,16
 
    if (t_num == 0)
    {
        v_PWMregs->TCFG1 &= ~0x0F;
        v_PWMregs->TCFG1 |= tmp;
    }
    else
    {
        v_PWMregs->TCFG1 &= ~(0x0F << 4);
        v_PWMregs->TCFG1 |= (tmp << 4);   
    }
    
    return TRUE;
}

/*******************************************************************************************
函数名称: PWM_StartPWM
描    述: 设置定时器 0 或 1 的周期和占空比, 并启动 pwm
输入参数: DWORD t_num: 定时器编号: 0 或 1
          DWORD cycle: 取值为 0 ~ 65535
          DWORD duty : 取值为 0 ~ 63535
输出参数: 无
返    回: TRUE: 成功;  FALSE: 失败
注    意: 占空比为 duty / cycle
********************************************************************************************/
BOOL PWM_StartPWM(DWORD t_num, DWORD cycle, DWORD duty)
{
	DWORD tmp;

    if ((cycle > 65535)||(duty > 65535))
        return FALSE;
    
    if ((duty > cycle)||(t_num > 1))
		return FALSE;

    if (t_num == 0)
    {
        PWM_ConfigPin(0);    
        v_PWMregs->TCNTB0 = cycle & 0xFFFF; 			// 定时值(PWM周期)       
        v_PWMregs->TCMPB0 = duty & 0xFFFF;				// 设置PWM占空比

		tmp = v_PWMregs->TCON;	
        if(tmp & (1 << 2))
		{
			tmp = tmp & (~0x0F) | (1 << 1);				 // 更新TCNTB0, TCMPB0
			v_PWMregs->TCON = tmp;		
		}
		else
		{	
			tmp = tmp & (~0x0F) | (1 << 1) | (1 << 2);	 // 更新TCNTB0, TCMPB0
			v_PWMregs->TCON = tmp;						 // TOUT0翻转输出
		}
	
		tmp = v_PWMregs->TCON;
		tmp = tmp & (~0x0F) | (1 << 0) | (1 << 3);
		v_PWMregs->TCON = tmp;							 // 开始定时器0, 自动加载模式
    }
    else
    {   
        PWM_ConfigPin(1);   
        v_PWMregs->TCNTB1 = cycle & 0xFFFF; 			 // 定时值(PWM周期)  
        v_PWMregs->TCMPB1 = duty & 0xFFFF;				 // 设置PWM占空比
   
		tmp = v_PWMregs->TCON;	
        if(v_PWMregs->TCON & (1 << 10))
		{
			tmp = tmp & (~0xF0) | (1 << 9);				 // 更新TCNTB1, TCMPB1
	   		v_PWMregs->TCON = tmp;	            
		}
		else
		{
			tmp = tmp & (~0xF0) | (1 << 9) | (1 << 10);	 // TOUT1翻转输出
			v_PWMregs->TCON = tmp;
		}

		tmp = v_PWMregs->TCON;
		tmp =  tmp & (~0xF0) | (1 << 8) | (1 << 11);	 // 开始定时器1, 自动加载模式	
	    v_PWMregs->TCON = tmp;
    }

	return TRUE;
}