pwm_test.c

来自「SMDK2410内部的PWM驱动程序和测试程序!」· C语言 代码 · 共 122 行

#include <stdio.h>
#include <stdlib.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sys/mman.h>
#include <linux/fb.h>
#include <unistd.h>
#include <termios.h>
#include <linux/kd.h>
#include <sys/ioctl.h>
#include <ctype.h>
#include <time.h>

#include "s3c2410_pwm.h"

int main(int argc, char** argv)
{	
	int fd;
	struct PWM_CHANNEL pwm[4];

	
	fd = open("/dev/pwm",O_RDWR);
	if(fd < 0)
	{
		printf("Can't open the s3c2410_pwm drivers!\n");
		return fd;
	}
	
	while(1)
	{	
		pwm[0].off = 0;
		pwm[0].div_clock = 0;
		pwm[0].prescaler0 = 100;
		pwm[0].tcmpb_reg = 40;
		pwm[0].tcntb_reg = 100;
		ioctl(fd,PWM_CHANNEL_0,&pwm[0]);
		
		printf("PWM Channel 0 freq = %d Hz \n",25000000/pwm[0].tcntb_reg/pwm[0].prescaler0);
		printf("PWM Channel 0 phrase = %d%c\n",pwm[0].tcmpb_reg*100/pwm[0].tcntb_reg,'%');
	
		pwm[1].off = 0;
		pwm[1].div_clock = 2;
		pwm[1].prescaler0 = 100;
		pwm[1].tcmpb_reg = 70;
		pwm[1].tcntb_reg = 100;
		ioctl(fd,PWM_CHANNEL_1,&pwm[1]);
		
		printf("PWM Channel 1 freq = %d\n",6250000/pwm[1].tcntb_reg/pwm[1].prescaler0);
		printf("PWM Channel 1 phrase = %d%c\n",pwm[1].tcmpb_reg*100/pwm[1].tcntb_reg,'%');
		
		pwm[2].off = 0;
		pwm[2].div_clock = 2;
		pwm[2].prescaler0 = 2;
		pwm[2].tcmpb_reg = 40;
		pwm[2].tcntb_reg = 100;
		ioctl(fd,PWM_CHANNEL_2,&pwm[2]);
		
		printf("PWM Channel 2 freq = %d Hz\n",25000000/pwm[2].tcntb_reg/pwm[2].prescaler0);
		printf("PWM Channel 2 phrase = %d%c\n",pwm[2].tcmpb_reg*100/pwm[2].tcntb_reg,'%');
		
		pwm[3].off = 0;
		pwm[3].div_clock = 2;
		pwm[3].prescaler0 = 2;
		pwm[3].tcmpb_reg = 40;
		pwm[3].tcntb_reg = 100;
		ioctl(fd,PWM_CHANNEL_3,&pwm[3]);
		
		printf("PWM Channel 3 freq = %d Hz\n",25000000/pwm[2].tcntb_reg/pwm[2].prescaler0);
		printf("PWM Channel 3 phrase = %d%c\n",pwm[2].tcmpb_reg*100/pwm[2].tcntb_reg,'%');	
		printf("\n");

				
		usleep(1000*5000);
		
		pwm[0].off = 0;
		pwm[0].div_clock = 0;
		pwm[0].prescaler0 = 100;
		pwm[0].tcmpb_reg = 600;
		pwm[0].tcntb_reg = 5000;
		ioctl(fd,PWM_CHANNEL_0,&pwm[0]);
		
		printf("PWM Channel 0 freq = %d Hz\n",25000000/pwm[0].tcntb_reg/pwm[0].prescaler0);
		printf("PWM Channel 0 phrase = %d%c\n",pwm[0].tcmpb_reg*100/pwm[0].tcntb_reg,'%');

		pwm[1].off = 0;
		pwm[1].div_clock = 2;
		pwm[1].prescaler0 = 100;
		pwm[1].tcmpb_reg = 400;
		pwm[1].tcntb_reg = 8000;
		ioctl(fd,PWM_CHANNEL_1,&pwm[1]);
		
		printf("PWM Channel 1 freq = %d\n",6250000/pwm[1].tcntb_reg/pwm[1].prescaler0);
		printf("PWM Channel 1 phrase = %d%c\n",pwm[1].tcmpb_reg*100/pwm[1].tcntb_reg,'%');

		pwm[2].off = 0;
		pwm[2].div_clock = 2;
		pwm[2].prescaler0 = 100;
		pwm[2].tcmpb_reg = 40;
		pwm[2].tcntb_reg = 100;
		ioctl(fd,PWM_CHANNEL_2,&pwm[2]);
		
		printf("PWM Channel 2 freq = %d Hz\n",25000000/pwm[2].tcntb_reg/pwm[2].prescaler0);
		printf("PWM Channel 2 phrase = %d%c\n",pwm[2].tcmpb_reg*100/pwm[2].tcntb_reg,'%');

		pwm[3].off = 0;
		pwm[3].div_clock = 2;
		pwm[3].prescaler0 = 100;
		pwm[3].tcmpb_reg = 40;
		pwm[3].tcntb_reg = 100;
		ioctl(fd,PWM_CHANNEL_3,&pwm[3]);
		
		printf("PWM Channel 3 freq = %d Hz\n",25000000/pwm[2].tcntb_reg/pwm[2].prescaler0);
		printf("PWM Channel 3 phrase = %d%c\n",pwm[2].tcmpb_reg*100/pwm[2].tcntb_reg,'%');
		printf("\n");	
		usleep(1000*5000);			
	}
	close(fd);	
	return 0;	
}