自学教程：C++ sys_inb函数代码示例

void kbd_command_leds(short leds){	unsigned long cenas;	unsigned passou1 =0,passou2 = 0;	while(!passou1){		send_kbd(0xED);		receive_kbd();		sys_inb(IN_BUF,&cenas);		if(cenas == RESEND)			continue;		else if(cenas == ERROR)			kbd_command_leds(leds);		else			passou1 =1;	}	while(!passou2){		send_kbd(leds);		receive_kbd();		sys_inb(IN_BUF,&cenas);		if(cenas == RESEND)			continue;		else if(cenas == ERROR)			kbd_command_leds(leds);		else			passou2 =1;	}}

int initialize_fifos(void){	receive_fifo = new_char_queue_t(receive_fifo);	transmit_fifo = new_char_queue_t(transmit_fifo);	unsigned long fcr = 0;	if(sys_inb(COM1+FIFO_CTRL_REG, &fcr) != OK)	{		printf("Error reading FIFO_CTRL_REG/n");		return 1;	}	fcr |= FIFO_INIT;	if(sys_outb(COM1+FIFO_CTRL_REG, fcr) != OK)	{		printf("Error writing to FIFO_CTRL_REG/n");		return 1;	}	if(sys_inb(COM2+FIFO_CTRL_REG, &fcr) != OK)	{		printf("Error reading FIFO_CTRL_REG/n");		return 1;	}	fcr |= FIFO_INIT;	if(sys_outb(COM2+FIFO_CTRL_REG, fcr) != OK)	{		printf("Error writing to FIFO_CTRL_REG/n");		return 1;	}	return 0;}

int readKBCState() {	unsigned long stat, data, counter = 0;	while (counter < 3) {		if (sys_inb(STAT_REG, &stat) != OK)			return -1;		if ((stat & (OBF | AUX)) != OK) {			if (sys_inb(DATA_REG, &data) != OK)				return -1;			if ((stat & (PAR_ERR | TO_ERR)) == 0)				return data;			else if (data == 0xFC)				return data;			else if (data == 0xFE)				return data;			else				return -1;			break;		}		tickdelay(micros_to_ticks(DELAY_US));		counter++;	}	return data;}

int get_divisor_latch(unsigned long com_address,unsigned long* dl){	unsigned long lsb = 0;	unsigned long msb = 0;	unsigned long lcr = 0;	if(sys_inb(com_address + LINE_CTRL_REG, &lcr) != OK)	{		printf("Error reading LINE_CTRL_REG/n");		return 1;	}	unsigned long newlcr = lcr | DLAB;	if(sys_outb(com_address + LINE_CTRL_REG, newlcr) != OK)	{		printf("Error writing LINE_CTRL_REG/n");		return 1;	}	if(sys_inb(com_address + DIVISOR_LATCH_LSB, &lsb) != OK)	{		printf("Error reading DIVISOR_LATCH_LSB/n");		return 1;	}	if(sys_inb(com_address + DIVISOR_LATCH_MSB, &msb) != OK)	{		printf("Error reading DIVISOR_LATCH_MSB/n");		return 1;	}	if(sys_outb(com_address + LINE_CTRL_REG, lcr) != OK)	{		printf("Error writing LINE_CTRL_REG/n");		return 1;	}	*dl = (msb << 8) + lsb;	return 0;}

int read_kbc(void) { LOG    unsigned long stat, data, counter = 0;    while (counter < TIMEOUT_COUNTER) {        if (sys_inb(STAT_REG, &stat) != 0) {            printf("read_kbc: sys_inb (1) failed./n");            return -1;        }        if ((stat & (OBF | AUX)) != 0) {            if (sys_inb(DATA_REG, &data) != 0) {                printf("read_kbc: sys_inb (2) failed./n");                return -1;            }            if ((stat & (PAR_ERR | TO_ERR)) == 0)                return data;            else if (data == ERROR)                return data;            else if (data == REPEAT)                return data;            else                return -1;        }        if (tickdelay(micros_to_ticks(DELAY_US)) != 0) {            printf("read_kbc: tickdelay failed./n");            return -1;        }        counter++;    }    return -1;}

int test_config(void) {	unsigned long status;	mouse_subscribe_int();	while (mouse_send_command(MOUSE_STATUS) != 0) {	};	if (sys_inb(OUT_BUF, &status) == OK) {		if (status & BIT(3) & BIT(0)) {			printf("1:1 - Linear mode/n");		} else {			printf("2:1 - Acceleration mode/n");		}		if (status & BIT(5)) {			printf("Info Report: ON/n ");		} else {			printf("Info Report: OFF/n ");		}		if (status & BIT(6)) {			printf("remote: ON/n");		} else {			printf("remote: OFF/n");		}		sys_inb(OUT_BUF, &status);		printf("X Delta: 0x%x/n", status);		if (sys_inb(OUT_BUF, &status) == OK) {			printf("Y Delta: 0x%x/n", status);		}	}	mouse_unsubscribe_int();	return 0;}

void clean_OBF(){	unsigned long stat;	do	{sys_inb(STAT_REG, &stat);	if(stat & OBF) //if OBF has something		sys_inb(OUT_BUF,&BUFFER_CLEAN_BYTE);	}	while(stat & OBF); //while OBF is full}

int cleanBuffer(){	unsigned long stat, data;	sys_inb(STAT_REG, &stat);	while (stat & OBF)	{		sys_inb(OUT_BUF, &data);		sys_inb(STAT_REG, &stat);	}	return 0;}

int mouse_read(unsigned long* val) {	unsigned long read = 0;	int i = 0;	for (i = 0; i < KBC_IO_MAX_TRIES; i++) {		sys_inb(STAT_REG, &read);		if ((read & OBF) && (read & AUX)) {			if (sys_inb(OUT_BUF, val) != 0) {				return -1;			}			return 0;		}		tickdelay(micros_to_ticks(DELAY_US));	}	return -1;}

int kbc_read(unsigned char *data) {	unsigned char status = 0;	int i;	for (i = 0; i < 16; i++) {		sys_inb(STAT_REG, (unsigned long *) &status);		if ((status & OBF) != 0) {			if (sys_inb(OUT_BUF, (unsigned long *) data) != OK) {				return ERROR;			}			return OK;		}		tickdelay(micros_to_ticks(DELAY));	}	return ERROR;}

int ms_read() {	unsigned long stat, key;	int i = 0;	while (i < 10) {		if (sys_inb(STAT_REG, &stat) != OK)			return -1;		if (stat & OBF) {			sys_inb(OUT_BUF, &key);			return key;		}		tickdelay(micros_to_ticks(DELAY_US));		i++;	}}

int receive_kbd(){	unsigned long stat;	while( 1 ) {			sys_inb(STAT_REG, &stat); /* assuming it returns OK */			/* loop while 8042 output buffer is empty*/			if( stat & OBF ) {				sys_inb(OUT_BUF, &data); /* assuming it returns OK*/				if ( (stat &(PAR_ERR | TO_ERR)) == 0 )					return data;				else					return -1;			}			tickdelay(micros_to_ticks(DELAY_US));		}}

//write a value to kbc without resendingint write_to_kbc_no_resend(port_t port,unsigned long value, unsigned char read_response){	int attempts = 0;	unsigned long stat;	unsigned long response=0;	while(1)	{		if(attempts >= MAX_ATTEMPTS){			printf("write_to_kbc_no_resend() failed, max attempts reached: %d/n", attempts);			return -1;		}		if(sys_inb(STAT_REG, &stat)!= OK){			printf("write_to_kbc_no_resend() failed, failure reading status/n");			return -1;		}		if( (stat & IN_BUF_STATUS) == 0 ) {			if(sys_outb(port, value) != OK){				printf("write_to_kbc_no_resend() failed, failure writing value 0x%x, at port 0x%x/n", value, port);				return -1;			}			if(read_response)			read_kbd_value(&response);			break;		}		attempts++;		WAIT_MS(WAIT_TIME);	}	return response;}

int mouse_read(unsigned num_tries, unsigned char* output){	size_t i, j;	unsigned long status;	for (i = 0; i < num_tries; ++i)	{		for (j = 0; j < num_tries; ++j)		{			int result = kbc_wait_for_out_buf(num_tries);			if (result == -1)			{				return 1;			}			else if (result == 0)			{				break;			}		}		if (kbc_read_status(&status))		{			return 1;		}		if (sys_inb(I8042_OUT_BUF, (unsigned long *)output) != OK)		{			return 1;		}		if (status & BIT(I8042_STATUS_AUX_BIT))		{			break;		}		// Discard byte	}	return 0;}

int get_kbd_status(){	unsigned long status;	sys_inb(BUF_STAT, &status);	return status;}

int write_kbc(unsigned long port, unsigned char byte) { LOG    unsigned long stat, counter = 0;    while (counter < TIMEOUT_COUNTER) {        if (sys_inb(STAT_REG, &stat) != 0) {            printf("write_kbc: sys_inb failed./n");            return -1;        }        if(!(stat & IBF)) {            if (sys_outb(port, byte) != 0) {                printf("write_kbc: sys_outb failed./n");                return -1;            }            return 0;        }        if (tickdelay(micros_to_ticks(DELAY_US)) != 0) {            printf("write_kbc: tickdelay failed./n");            return -1;        }        counter++;    }    printf("write_kbc: time out./n");    return -1;}

/*===========================================================================* *			helper functions for I/O										 * *===========================================================================*/PUBLIC unsigned pci_inb(U16_t port) {	u32_t value;	int s;	if ((s=sys_inb(port, &value)) !=OK)		printf("%s: warning, sys_inb failed: %d/n", DRIVER_NAME, s);	return value;}

static u32_t pci_inb(u16_t port) {	u32_t value;	int s;	if ((s=sys_inb(port, &value)) !=OK)		printf("ACPI: warning, sys_inb failed: %d/n", s);	return value;}

int writeToKBC(unsigned long reg, unsigned long cmd){	unsigned long stat, r, data, i = 0;	while(i < 3) // retry 3 times on time-out	{		r = sys_inb(STAT_REG, &stat);		if (r != OK)		{			printf("sys_inb failed with: %d", r);			return -1;		}		if ((stat & IBF) == 0)		{			r = sys_outb(reg, cmd);			if (r != OK)			{				printf("sys_inb failed with: %d", r);				return -1;			}			else return 0;		}		// gives the KBC or the keyboard enough-time to respond		tickdelay(micros_to_ticks(DELAY_US));		i++;	}	printf("writeToKBC failed: unable to write data/n");	return -1;}

int kbd_read_status(){	unsigned long stat;	sys_inb(STAT_BUF, &stat);	return stat;}

int set_divisor_latch(unsigned long com_address,unsigned long dl){	unsigned long lsb = dl & 0xFF;	unsigned long msb = dl >> 8;	unsigned long lcr = 0;	if(sys_inb(com_address + LINE_CTRL_REG, &lcr) != OK)	{		printf("Error reading LINE_CTRL_REG/n");		return 1;	}	unsigned long newlcr = lcr | DLAB;	if(sys_outb(com_address + LINE_CTRL_REG, newlcr) != OK)	{		printf("Error writing LINE_CTRL_REG/n");		return 1;	}	if(sys_outb(com_address + DIVISOR_LATCH_LSB, lsb) != OK)	{		printf("Error writing DIVISOR_LATCH_LSB/n");		return 1;	}	if(sys_outb(com_address + DIVISOR_LATCH_MSB, msb) != OK)	{		printf("Error writing DIVISOR_LATCH_MSB/n");		return 1;	}	if(sys_outb(com_address + LINE_CTRL_REG, lcr) != OK)	{		printf("Error writing LINE_CTRL_REG/n");		return 1;	}	return 0;}

int timer_get_conf(unsigned long timer, unsigned long *st) {	if (sys_outb(TIMER_CTRL, TIMER_RB_SEL(timer) | TIMER_RB_CMD | TIMER_RB_COUNT_))	{		return 1;	}	switch(timer)	{	case 0:		return sys_inb(TIMER_0, st);	case 1:		return sys_inb(TIMER_1, st);	case 2:		return sys_inb(TIMER_2, st);	default:		return 1;	}}

void load_config(unsigned long registers[]){	disable();		sys_outb(RTC_ADDR_REG, 10);	sys_inb(RTC_DATA_REG,&registers[0]);		sys_outb(RTC_ADDR_REG, 11);	sys_inb(RTC_DATA_REG,&registers[1]);		sys_outb(RTC_ADDR_REG, 12);	sys_inb(RTC_DATA_REG,&registers[2]);		sys_outb(RTC_ADDR_REG, 13);	sys_inb(RTC_DATA_REG,&registers[3]);		enable();}

static unsigned my_inb(u16_t port){	u32_t value;	int s;	if ((s = sys_inb(port, &value)) != OK)		printf("RTL8169: warning, sys_inb failed: %d/n", s);	return value;}

int rec_cmd(){	unsigned long stat = 0;	unsigned long OBF = 0x0001;	unsigned long data = 0;	while( 1 ) {		sys_inb(STAT_REG, &stat);		if( stat & OBF ) {			sys_inb(OUT_BUF, &data);			if ( (stat &(PAR_ERR | TO_ERR)) == 0 )				return data;			else				return -1;		}		tickdelay(micros_to_ticks(DELAY_US));	}}

/***  Name:	unsigned int inb(unsigned short int port);**  Function:	Reads a byte from specified i/o port.*/PUBLIC unsigned int inb(unsigned short port){  unsigned int value;  int rc;  if ((rc = sys_inb(port, &value)) != OK) warning("inb", rc);  return value;}

int kbd_interrupt_handler_read(){ //  reads the bytes from the KBC’s OUT_BUF	unsigned long stat, key;	while( 1 ) {	if(sys_inb(STAT_REG, &stat) != OK)		return -1;	   if( stat & OBF ) {	     sys_inb(OUT_BUF, &key); // assuming it returns OK	   if ( (stat &(PAR_ERR | TO_ERR)) == 0 )	     return key;	    else	     return -1;	}	   tickdelay(micros_to_ticks(DELAY_US));	}}

int kbd_int_handler() {	unsigned long stat = 0;	sys_inb(OUT_BUFF, &stat);	if ((stat & BREAKCODE) != BREAKCODE) {		return stat;	}}

int read_keyboard(){while(1){	sys_inb(STAT_REG,&stat); //assuming it returns OK	if(stat & OBF)	{		sys_inb(OUT_BUF,&data); //assuming it returns OK		if((stat&(PAR_ERR|TO_ERR))==0)			return data;		else			return -1;	}	tickdelay(micros_to_ticks(DELAY_US));	}}

int ser_set(unsigned short base_addr, unsigned long bits, unsigned long stop,        long parity, unsigned long rate){	if(base_addr != 1 && base_addr != 2)	{		printf("Incorrect com: d%/n", base_addr);		return 1;	}	if(bits < 5 || bits > 8)	{		printf("Incorrect number of bits: %d/n", bits);		return 1;	}	if(rate != STD_RATE_VALUE_1 && rate != STD_RATE_VALUE_2 && rate != STD_RATE_VALUE_3 && rate !=STD_RATE_VALUE_4 && rate !=STD_RATE_VALUE_5 && rate != STD_RATE_VALUE_6 && rate != STD_RATE_VALUE_7  && rate!= STD_RATE_VALUE_8 )	{		printf("Incorrect rate: %d/n", rate);		return 1;	}	if(stop != 1 && stop != 2)	{		printf("Incorrect number of stop bits: %d/n", parity);		return 1;	}	if(parity < 0 || parity > 7)	{		printf ("Incorrect parity/n");		return 1;	}	unsigned long com_address;	if(base_addr == 1)		com_address = COM1;	else com_address = COM2;	unsigned long writable_word_length = bits - 5;	unsigned long writable_stop_bits = ((stop-1) << 2);	unsigned long writable_parity = (parity << 3);	unsigned long out = writable_parity|writable_stop_bits|writable_word_length;	unsigned long lcr = 0;	if(sys_inb(com_address + LINE_CTRL_REG, &lcr) != OK)	{		printf("Error reading LINE_CTRL_REG/n");		return 1;	}	out |= (lcr & (DLAB|SET_BREAK_ENABLE));	if(sys_outb(com_address + LINE_CTRL_REG, out) != OK)	{		printf("Error writing LINE_CTRL_REG/n");		return 1;	}	unsigned long divisor = UART_FREQ / rate;	if(set_divisor_latch(com_address, divisor))	{		printf("Error setting divisor_latch/n");		return 1;	}	return 0;}