dc_isp116x.c

来自「isp1161a USB主控制芯片驱动」· C语言 代码 · 共 38 行

static inline int dc_READ_REG16 (unsigned long cmd_port, unsigned long data_port, int regindex)
{
    int val = 0;

    ISP116x_OUTW (regindex, cmd_port);
    ndelay(300);
    val = ISP116x_INW (data_port);
    ndelay(110);
    return val;
}

static inline void dc_WRITE_REG16 (unsigned long cmd_port, unsigned long data_port, unsigned int value, int regindex)
{
    ISP116x_OUTW (regindex, cmd_port);
    ndelay(300);
    ISP116x_OUTW (value, data_port);
    ndelay(110);
}

static unsigned long dc_data_port       = IDE_BASE + (0xC2<<2);
static unsigned long dc_cmd_port        = IDE_BASE + (0xC3<<2);

static void dc_set_reg(void)
{
	int value;
	value = dc_READ_REG16(dc_cmd_port, dc_data_port, 0xb5);
	printk("<0>    dcChipID = %x\n", value);
	value = dc_READ_REG16(dc_cmd_port, dc_data_port, 0xbb);
	printk("<0>    dcHardwareConfiguration = %x\n", value);
	value &= ~((u32)3);
	value |= 1;	/* high level int */
	dc_WRITE_REG16(dc_cmd_port, dc_data_port, value, 0xba);

	value = dc_READ_REG16(dc_cmd_port, dc_data_port, 0xbb);
	printk("<0>    dcHardwareConfiguration = %x\n", value);
}