/******************************************************************* Components for embedded applications builded for laboratory and medical instruments firmware (COLAMI) kbd_mx1sl.c - periodically scanned keyboard MicroWindows driver Copyright holders and project originators (C) 2001-2004 by Pavel Pisa pisa@cmp.felk.cvut.cz (C) 2002-2004 by PiKRON Ltd. http://www.pikron.com The COLAMI components can be used and copied under next licenses - MPL - Mozilla Public License - GPL - GNU Public License - LGPL - Lesser GNU Public License - and other licenses added by project originators Code can be modified and re-distributed under any combination of the above listed licenses. If contributor does not agree with some of the licenses, he can delete appropriate line. Warning, if you delete all lines, you are not allowed to distribute code or build project. *******************************************************************/ #include #include #include "device.h" #define WITH_RTEMS #undef DEBUG #ifndef WITH_RTEMS #include #include #include #include #define KEY_TIMER msec_time #define KEY_PUSH_T 20 #define KEY_RELEASE_T 10 #define KEY_REPFIRST_T 700 #define KEY_REPNEXT_T 200 typedef long mx1_kbd_interval_t; #define KBD_DR _reg_PTD_DR #define KBD_SSR _reg_PTD_SSR #define KBD_DDIR _reg_PTD_DDIR #define KBD_PUEN _reg_PTD_PUEN typedef unsigned long kbdisr_lock_level_t; #define kbdisr_lock save_and_cli #define kbdisr_unlock restore_flags #else /*WITH_RTEMS*/ #include #include #include #include #include #include #include #include #include #define KEY_TIMER ({rtems_interval ticks=0; \ rtems_clock_get(RTEMS_CLOCK_GET_TICKS_SINCE_BOOT,&ticks); \ ticks; \ }) /*to obtain tick resolution use RTEMS_CLOCK_GET_TICKS_PER_SECOND*/ /*rtems/config.h: rtems_configuration_get_microseconds_per_tick()*/ #define KEY_PUSH_T 20 #define KEY_RELEASE_T 10 #define KEY_REPFIRST_T 700 #define KEY_REPNEXT_T 200 typedef rtems_interval mx1_kbd_interval_t; #define KBD_DR MC9328MXL_GPIOD_DR #define KBD_SSR MC9328MXL_GPIOD_SSR #define KBD_DDIR MC9328MXL_GPIOD_DDIR #define KBD_PUEN MC9328MXL_GPIOD_PUEN #define KBD_IMR MC9328MXL_GPIOD_IMR #define KBD_ISR MC9328MXL_GPIOD_ISR #define KBD_ICR1 MC9328MXL_GPIOD_ICR1 #define KBD_ICR2 MC9328MXL_GPIOD_ICR2 #define KBD_IRQ_NUM BSP_INT_GPIO_PORTD #define KBD_ISR_EVENT RTEMS_EVENT_26 typedef rtems_interrupt_level kbdisr_lock_level_t; #define kbdisr_lock rtems_interrupt_disable #define kbdisr_unlock rtems_interrupt_enable #endif /*WITH_RTEMS*/ /* * MX_KBD matrix is 3 inputs x 8 outputs. * Outputs are PD23 to PD30 * Inputs are PD20 to PD22. */ #define KBD_SCAN_CNT 8 #define KBD_SCAN_BIT0 23 #define KBD_RET_CNT 3 #define KBD_RET_BIT0 20 #define KBD_SCAN_MASK (((1<>KBD_RET_BIT0)&((1<scan);mt++) { chng=(s==scan_code); s--; val=key_down_arr[s/KBD_RET_CNT]&(1<<(s%KBD_RET_CNT)); if(val) { key_mod|=mt->set_mod; if(chng){ key_mod^=mt->xor_mod; } } else { key_mod&=~mt->set_mod; } } } /** * mx1_kbd_down - Detects changed key scancode and applies changes to matrix state * * Functions check @key_chng_arr and process changes. * It updates its internal state @key_state, does * noise cancellation and repeat timing, then updates * @key_down_arr, stores detected scancode to @key_last_changed * and calls modifiers processing mx1_kbd_scan2mod(). * Return value is zero if no change is detected. * In other case evaluated scancode is returned. * Variable @key_hit signals by value 1 pressed key, by value * 2 key release. */ int mx1_kbd_down() { int i, j=0; unsigned char val; if(!(key_state&KEY_STATE_BUSY)){ for(i=0;i>=1; key_last_changed=i*KBD_RET_CNT+j+1; if(key_down_arr[i]&(1<50) ticks=50; } status=rtems_event_receive (KBD_ISR_EVENT, RTEMS_EVENT_ANY|RTEMS_WAIT, ticks, &events); #ifdef DEBUG if(0){ static int i=0; if(status==RTEMS_SUCCESSFUL) printf("K%d.%d\n",i,key_state); else printf("_%d.%d\n",i,key_state); if(++i>=10)i=0; } #endif /*DEBUG*/ kbdisr_lock(level); KBD_IMR &= ~KBD_RET_MASK; KBD_DR |= KBD_SCAN_MASK; kbdisr_unlock(level); } } static rtems_status_code mx1_kbd_hw_init(void) { kbdisr_lock_level_t level; rtems_status_code status; /* Set for negative edge triggered interupt => mode 1 */ uint32_t irq_mode=1; uint32_t irq_mask=(1<<(2*KBD_RET_CNT))-1; irq_mode = (irq_mode*0x55555555)&irq_mask; int kbd_ret_bit0 = KBD_RET_BIT0; mx1_kbd_setio(); /* Set for negative edge triggered interupt => mode 1 */ KBD_ICR1 &= ~(irq_mask<<(kbd_ret_bit0*2)); KBD_ICR1 |= (irq_mode<<(kbd_ret_bit0*2)); if(kbd_ret_bit0<16){ irq_mask >>= 2*(16-kbd_ret_bit0); irq_mode >>= 2*(16-kbd_ret_bit0); }else{ irq_mask <<= 2*(kbd_ret_bit0-16); irq_mode <<= 2*(kbd_ret_bit0-16); } KBD_ICR2 &= ~irq_mask; KBD_ICR2 |= irq_mode; if(!mx1_kbd_task){ status=rtems_task_create (rtems_build_name('M','X','K','B'), /*priority*/ 2, /*stacksize*/ RTEMS_MINIMUM_STACK_SIZE+1024, RTEMS_DEFAULT_MODES /*RTEMS_PREEMPT|RTEMS_NO_TIMESLICE|RTEMS_NO_ASR|RTEMS_INTERRUPT_LEVEL(0)*/, RTEMS_DEFAULT_ATTRIBUTES /*RTEMS_NO_FLOATING_POINT|RTEMS_LOCAL*/, &mx1_kbd_task); if (status != RTEMS_SUCCESSFUL){ printf("MX1_KBD: rtems_task_create %s\n",rtems_status_text(status)); return status; } /* Install the interrupt handler */ if (!BSP_install_rtems_irq_handler(&mx1_kbd_isr_data)){ printf("MX1_KBD: BSP_install_rtems_irq_handler failed\n"); return RTEMS_UNSATISFIED; } status = rtems_task_start (mx1_kbd_task, mx1_kbd_task_proc, (rtems_task_argument)0); if (status != RTEMS_SUCCESSFUL){ printf("MX1_KBD: rtems_task_start %s\n",rtems_status_text(status)); return status; } } /* Enable GPIO port A3 interrupt */ kbdisr_lock(level); KBD_DR &= ~KBD_SCAN_MASK; KBD_IMR |= KBD_RET_MASK; kbdisr_unlock(level); return RTEMS_SUCCESSFUL; } static rtems_device_driver mx1_kbd_init(rtems_device_major_number major,rtems_device_minor_number minor,void *arg) { /*rtems_libio_open_close_args_t* argp = (rtems_libio_open_close_args_t*)arg;*/ return mx1_kbd_hw_init(); } static rtems_device_driver mx1_kbd_open(rtems_device_major_number major,rtems_device_minor_number minor,void *arg) { /*rtems_libio_open_close_args_t* argp = (rtems_libio_open_close_args_t*)arg;*/ if(minor!=0) return RTEMS_UNSATISFIED; return RTEMS_SUCCESSFUL; } static rtems_device_driver mx1_kbd_close(rtems_device_major_number major,rtems_device_minor_number minor,void *arg) { /*rtems_libio_open_close_args_t* argp = (rtems_libio_open_close_args_t*)arg;*/ return RTEMS_SUCCESSFUL; } static rtems_device_driver mx1_kbd_read(rtems_device_major_number major,rtems_device_minor_number minor,void *arg) { rtems_libio_rw_args_t* argp = (rtems_libio_rw_args_t*)arg; char *buf = argp->buffer; int count = argp->count; argp->bytes_moved = 0; return RTEMS_SUCCESSFUL; } static rtems_device_driver mx1_kbd_write(rtems_device_major_number major,rtems_device_minor_number minor,void *arg) { /*rtems_libio_rw_args_t* argp = (rtems_libio_rw_args_t*)arg;*/ return RTEMS_UNSATISFIED; } /* adds a kbd message to the queue */ static void kbd_parser( void *ptr, unsigned short keycode, unsigned long modifiers) { struct MW_UID_MESSAGE m; m.type = MV_UID_KBD; m.m.kbd.code = keycode; m.m.kbd.modifiers = modifiers; m.m.kbd.mode = MV_KEY_MODE_ASCII; /*MV_KEY_MODE_SCANCODE*/ /* printf( "kbd: msg: keycode=%X, mod=%X\n", keycode, mods ); */ rtems_message_queue_send( mx1_kbd_queue_id, ( void * )&m, sizeof( struct MW_UID_MESSAGE ) ); } void kbd_set_driver_handler( void ( *handler )( void *, unsigned short, unsigned long ) ) { mx1_kbd_parser_fnc = handler; } void register_kbd_msg_queue( char *q_name, int port ) { rtems_name queue_name; rtems_status_code status; queue_name = rtems_build_name( q_name[0], q_name[1], q_name[2], q_name[3] ); status = rtems_message_queue_ident( queue_name, RTEMS_LOCAL, &mx1_kbd_queue_id ); if( status != RTEMS_SUCCESSFUL ) { printf( "UID_Queue: error open queue: %d\n", status ); return; } kbd_set_driver_handler( kbd_parser ); } void unregister_kbd_msg_queue( int port ) { kbd_set_driver_handler( NULL ); } static rtems_device_driver mx1_kbd_ioctl(rtems_device_major_number major,rtems_device_minor_number minor,void *arg) { rtems_libio_ioctl_args_t* argp = (rtems_libio_ioctl_args_t*)arg; switch(argp->command){ case MW_UID_REGISTER_DEVICE: register_kbd_msg_queue( argp->buffer, -1 ); break; case MW_UID_UNREGISTER_DEVICE: unregister_kbd_msg_queue( -1 ); default: return RTEMS_INVALID_NAME; } argp->ioctl_return = 0; return RTEMS_SUCCESSFUL; } rtems_status_code mx1_kbd_driver_init(void) { rtems_status_code status; status = rtems_io_register_driver(0,&mx1_kbd_driver_table,&mx1_kbd_major); if (status != RTEMS_SUCCESSFUL){ printf("MX1_KBD: rtems_io_register_driver %s\n",rtems_status_text(status)); return status; } status = rtems_io_register_name( "/dev/kbd", mx1_kbd_major, 0); if (status != RTEMS_SUCCESSFUL){ printf("MX1_KBD: rtems_io_register_name %s\n",rtems_status_text(status)); return status; } return RTEMS_SUCCESSFUL; } #endif /* WITH_RTEMS */ /* *----------------------------------------------------------- */ #ifndef WITH_RTEMS static int mx1_kbd_Open(KBDDEVICE *pkd); static void mx1_kbd_Close(void); static void mx1_kbd_GetModifierInfo(MWKEYMOD *modifiers, MWKEYMOD *curmodifiers); static int mx1_kbd_Read(MWKEY *buf, MWKEYMOD *modifiers, MWSCANCODE *scancode); static int mx1_kbd_Poll(void); KBDDEVICE kbddev = { mx1_kbd_Open, mx1_kbd_Close, mx1_kbd_GetModifierInfo, mx1_kbd_Read, mx1_kbd_Poll }; /** * mx1_kbd_scan2mwkey - Open the keyboard * @pkd: Pointer to keyboard device */ static int mx1_kbd_Open(KBDDEVICE *pkd) { key_last_changed=0; key_mod=0; key_hit=0; key_use_timer=0; memset(key_down_arr,0,sizeof(key_down_arr)); mx1_kbd_setio(); return 0; } /** * mx1_kbd_Close - Closes keyboard */ static void mx1_kbd_Close(void) { } /** * mx1_kbd_Poll - Polls for keyboard events * * Returns non-zero value if change is detected. */ static int mx1_kbd_Poll(void) { if(key_hit) return 1; if(mx1_kbd_scan()) mx1_kbd_down(); return key_hit?1:0; } /** * mx1_kbd_GetModifierInfo - Returns the possible modifiers for the keyboard * @modifiers: If non-NULL, ones in defined modifiers bits are returned. * @curmodifiers: If non-NULL, ones in actually active modifiers * bits are returned. */ static void mx1_kbd_GetModifierInfo(MWKEYMOD *modifiers, MWKEYMOD *curmodifiers) { if (modifiers) *modifiers = 0; /* no modifiers available */ if (curmodifiers) *curmodifiers = key_mod&~MWKMOD_SGM_SC; } /** * mx1_kbd_Read - Reads resolved MWKEY value, modifiers and scancode * @buf: If non-NULL, resolved MWKEY is stored here * @modifiers: If non-NULL, ones in actually active modifiers * bits are returned * @scancode: If non-NULL, scancode of resolved key is stored * here * * This function reads one keystroke from the keyboard, and the current state * of the modifier keys (ALT, SHIFT, etc). Returns -1 on error, 0 if no data * is ready, 1 on a keypress, and 2 on keyrelease. * This is a non-blocking call. */ static int mx1_kbd_Read(MWKEY *buf, MWKEYMOD *modifiers, MWSCANCODE *scancode) { int ret; if(!key_hit) { if(mx1_kbd_scan()){ mx1_kbd_down(); } } if(modifiers) *modifiers = key_mod&~MWKMOD_SGM_SC; if(!key_hit) return 0; if(scancode) *scancode = key_last_changed; if(buf) *buf = mx1_kbd_scan2mwkey(key_last_changed); ret=key_hit; key_hit=0; return ret; } #endif /* !WITH_RTEMS */