URL
https://opencores.org/ocsvn/minsoc/minsoc/trunk
Subversion Repositories minsoc
[/] [minsoc/] [trunk/] [utils/] [contributions/] [gpio/] [sw/] [old/] [gpio.c] - Rev 49
Go to most recent revision | Compare with Previous | Blame | View Log
#include "../support/support.h" #include "../support/board.h" #include "../support/uart.h" #include "../support/spr_defs.h" #include "gpio.h" void uart_print_str(char *); void uart_print_long(unsigned long); // Dummy or32 except vectors void buserr_except(){} void dpf_except(){} void ipf_except(){} void lpint_except(){} void align_except(){} void illegal_except(){} /*void hpint_except(){ }*/ void dtlbmiss_except(){} void itlbmiss_except(){} void range_except(){} void syscall_except(){} void res1_except(){} void trap_except(){} void res2_except(){} void uart_interrupt() { char lala; unsigned char interrupt_id; interrupt_id = REG8(UART_BASE + UART_IIR); if ( interrupt_id & UART_IIR_RDI ) { lala = uart_getc(); uart_putc(lala+1); } } void uart_print_str(char *p) { while(*p != 0) { uart_putc(*p); p++; } } void uart_print_long(unsigned long ul) { int i; char c; uart_print_str("0x"); for(i=0; i<8; i++) { c = (char) (ul>>((7-i)*4)) & 0xf; if(c >= 0x0 && c<=0x9) c += '0'; else c += 'a' - 10; uart_putc(c); } } void uart_print_short(unsigned long ul) { int i; char c; char flag=0; uart_print_str("0x"); for(i=0; i<8; i++) { c = (char) (ul>>((7-i)*4)) & 0xf; if(c >= 0x0 && c<=0x9) c += '0'; else c += 'a' - 10; if ((c != '0') || (i==7)) flag=1; if(flag) uart_putc(c); } } /* * * * * * * * * * */ void gpio_init(gpio_t *gpio, long instance_num, unsigned long base_addr) { int i = MIN_GPIO_BIT; if ( gpio != NULL ) { gpio->instance_num = instance_num; gpio->base_addr = (unsigned char*)base_addr; for ( ;i<=MAX_GPIO_BIT;i++) gpio->vectors[i].vec = NULL; return; } else { // Print the error msgs here // uart_print_str("gpio inst in NULL.\n"); return; } } void gpio_config_bit(gpio_t *gpio, unsigned long bit, iotype_t io) { if ( gpio != NULL ) { if ( io == IO_INPUT ) { gpio->io_config |= (1 << bit); *(unsigned long*)(gpio->base_addr + OE_REG_OFFSET) &= (~(1 << bit)); } else { gpio->io_config &= (~(1 << bit)); *(unsigned long*)(gpio->base_addr + OE_REG_OFFSET) |= (1 << bit); } return; } else { // Print the error msgs here // uart_print_str("gpio inst in NULL.\n"); return; } } void gpio_set_bit(gpio_t *gpio, unsigned long bit, unsigned long val) { if ( gpio != NULL ) { if ( val != 0 ) *(unsigned long*)(gpio->base_addr + OUT_REG_OFFSET) |= (1 << bit); else *(unsigned long*)(gpio->base_addr + OUT_REG_OFFSET) &= (~(1 << bit)); return; } else { // Print the error msgs here // uart_print_str("gpio inst in NULL.\n"); return; } } void gpio_get_bit(gpio_t *gpio, unsigned long bit, unsigned long *val) { unsigned long temp; if ( gpio != NULL ) { temp = *(unsigned long*)(gpio->base_addr + IN_REG_OFFSET); *val = (temp & (1 << bit))? 1 : 0; return; } else { // Print the error msgs here // uart_print_str("gpio inst in NULL.\n"); return; } } void gpio_add_interrupt(gpio_t *gpio, unsigned int bit, edge_t edge,void (*func)() ) { if ( gpio != NULL ) { if ( ( gpio->io_config &(1 << bit)) != 0 ) { // Port bit is configured as IO_INPUT // // Disable the interrupts // *(unsigned long*)(gpio->base_addr + CTRL_REG_OFFSET) &= (~0x01); // Enable the interrupt bit // *(unsigned long*)(gpio->base_addr + INTE_REG_OFFSET) |= (1 << bit); // Enable the edge type // if ( edge == POS_EDGE ) *(unsigned long*)(gpio->base_addr + PTRIG_REG_OFFSET) |= (1 << bit); else *(unsigned long*)(gpio->base_addr + PTRIG_REG_OFFSET) &= (~(1 << bit)); // Set the function vector // gpio->vectors[bit].vec = func; int_add( 6, gpio_interrupt, gpio ); // Re-enable the global control bit // *(unsigned long*)(gpio->base_addr + CTRL_REG_OFFSET) |= 0x01; } else { // Port is configured as IO_OUTPUT uart_print_str("gpio pin is not an input pin.\n"); return; } } else { // Print the error msgs here // uart_print_str("gpio inst in NULL.\n"); return; } } void gpio_interrupt(gpio_t *gpio) { int i; unsigned long int interrupt_status; if ( (*(unsigned long*)(gpio->base_addr + CTRL_REG_OFFSET)) & 0x02 ) { // Interrupt is pending here // interrupt_status = *(unsigned long*)(gpio->base_addr + INTS_REG_OFFSET); // Prioritize from lower bits(0) to higher ones(31) // for ( i=MIN_GPIO_BIT; i<=MAX_GPIO_BIT; i++ ) { if ( (interrupt_status & (1<<i)) ) { *(unsigned long*)(gpio->base_addr + INTS_REG_OFFSET) &= (~( 1 << i )); (gpio->vectors[i].vec)(); } } *(unsigned long*)(gpio->base_addr + CTRL_REG_OFFSET) &= (~0x02); } } void hello_east() { uart_print_str("Hello from PUSH Button EAST.\n"); } void hello_west() { uart_print_str("Hello from PUSH Button WEST.\n"); } void hello_south() { uart_print_str("Hello from PUSH Button SOUTH.\n"); } #define MAX_COUNT 10 int main() { gpio_t gpio_1; unsigned long t0, t1, t2, t3; unsigned long count = 0; uart_init(); int_init(); int_add(2,&uart_interrupt); gpio_init( &gpio_1, 1, GPIO_BASE ); gpio_config_bit( &gpio_1, LED_0, IO_OUTPUT); gpio_config_bit( &gpio_1, LED_1, IO_OUTPUT); gpio_config_bit( &gpio_1, LED_2, IO_OUTPUT); gpio_config_bit( &gpio_1, LED_3, IO_OUTPUT); gpio_config_bit( &gpio_1, LED_4, IO_OUTPUT); gpio_config_bit( &gpio_1, LED_5, IO_OUTPUT); gpio_config_bit( &gpio_1, LED_6, IO_OUTPUT); gpio_config_bit( &gpio_1, LED_7, IO_OUTPUT); gpio_config_bit( &gpio_1, DIP_0, IO_INPUT); gpio_config_bit( &gpio_1, DIP_1, IO_INPUT); gpio_config_bit( &gpio_1, DIP_2, IO_INPUT); gpio_config_bit( &gpio_1, DIP_3, IO_INPUT); uart_print_str("Demo 1 : Check for running LED patterns on board ...\n"); while ( count++ < MAX_COUNT ) { gpio_set_bit( &gpio_1, LED_7, 0 ); gpio_set_bit( &gpio_1, LED_0, 1 ); udelay( 100000 ); gpio_set_bit( &gpio_1, LED_0, 0 ); gpio_set_bit( &gpio_1, LED_1, 1 ); udelay( 100000 ); gpio_set_bit( &gpio_1, LED_1, 0 ); gpio_set_bit( &gpio_1, LED_2, 1 ); udelay( 100000 ); gpio_set_bit( &gpio_1, LED_2, 0 ); gpio_set_bit( &gpio_1, LED_3, 1 ); udelay( 100000 ); gpio_set_bit( &gpio_1, LED_3, 0 ); gpio_set_bit( &gpio_1, LED_4, 1 ); udelay( 100000 ); gpio_set_bit( &gpio_1, LED_4, 0 ); gpio_set_bit( &gpio_1, LED_5, 1 ); udelay( 100000 ); gpio_set_bit( &gpio_1, LED_5, 0 ); gpio_set_bit( &gpio_1, LED_6, 1 ); udelay( 100000 ); gpio_set_bit( &gpio_1, LED_6, 0 ); gpio_set_bit( &gpio_1, LED_7, 1 ); udelay( 100000 ); } gpio_set_bit( &gpio_1, LED_7, 0 ); gpio_config_bit( &gpio_1, PUSH_EAST, IO_INPUT); gpio_add_interrupt( &gpio_1, PUSH_EAST, POS_EDGE, hello_east ); gpio_config_bit( &gpio_1, PUSH_WEST, IO_INPUT); gpio_add_interrupt( &gpio_1, PUSH_WEST, POS_EDGE, hello_west ); gpio_config_bit( &gpio_1, PUSH_SOUTH, IO_INPUT); gpio_add_interrupt( &gpio_1, PUSH_SOUTH, POS_EDGE, hello_south ); uart_print_str("Demo 2 : Press the DIP switches and watch corresponding LED glow ...\n"); while (1) { gpio_get_bit( &gpio_1, DIP_0, &t0 ); gpio_get_bit( &gpio_1, DIP_1, &t1 ); gpio_get_bit( &gpio_1, DIP_2, &t2 ); gpio_get_bit( &gpio_1, DIP_3, &t3 ); // gpio_set_bit( &gpio_1, LED_0, t0 ); gpio_set_bit( &gpio_1, LED_1, t1 ); gpio_set_bit( &gpio_1, LED_2, t2 ); gpio_set_bit( &gpio_1, LED_3, t3 ); } report(0xdeaddead); or32_exit(0); }
Go to most recent revision | Compare with Previous | Blame | View Log