dip4.c

来自「S3C4510(ARM7)开发板bootloader实现及板载硬件测试代码」· C语言 代码 · 共 39 行

#include "dip4.h"

static int dip_value(int *val_buf, int n)
{
	int i;
	int val, res;

	IOPMOD = IOPMOD & 0xfffffff0;	
	IOPDATA = IOPDATA | 0x0000000f;
		
	val = IOPDATA & 0x0f;
	res = 0x0;	
	for (i = 0; i < n; i++)
	{
		val_buf[i] = (val & (0x01 << i)) ? 1 : 0;
		res = res | (val_buf[i] << i);		
	}
	return res;
}

void dip4demo(void)
{
	int dipval;
	int val_buf[DIP_NUM];
	
	uart_get = -INT_MAX;
	puts("dip4 value show by seg7, press 'q' to end test\r\n");
	do
	{
		dipval = dip_value(val_buf, DIP_NUM);
		seg7(dipval);
		led_set_val(dipval);
	} 
	while (uart_get != 'q');
	seg7(0);
	led_set_val(0);
	
	return;
}