root/platform/s110/kbd.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. get_usb_bit
  2. wrap_kbd_p1_f
  3. mykbd_task
  4. my_kbd_read_keys
  5. kbd_fetch_data
  6. jogdial_control
  7. get_jogdial_direction

   1 #include "lolevel.h"
   2 #include "platform.h"
   3 #include "keyboard.h"
   4 #include "kbd_common.h"
   5 
   6 long kbd_new_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
   7 long kbd_prev_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
   8 long kbd_mod_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
   9 
  10 extern void _GetKbdState(long*);
  11 
  12 int get_usb_bit() 
  13 {
  14     long usb_physw[3];
  15     usb_physw[USB_IDX] = 0;
  16     _kbd_read_keys_r2(usb_physw);
  17     return(( usb_physw[USB_IDX] & USB_MASK)==USB_MASK) ; 
  18 }
  19 
  20 KeyMap keymap[] = {
  21     { 0, KEY_ERASE           ,0x00000001 }, // RING FUNC
  22     { 0, KEY_DOWN            ,0x00000002 }, // Found @0xf864bbbc, levent 0x05
  23     { 0, KEY_DISPLAY         ,0x00000002 }, // ^
  24     { 0, KEY_LEFT            ,0x00000004 }, // Found @0xf864bbc4, levent 0x06
  25     { 0, KEY_MENU            ,0x00000008 }, // Found @0xf864bbcc, levent 0x09
  26     { 0, KEY_SET             ,0x00000020 }, // Found @0xf864bbdc, levent 0x08
  27     { 0, KEY_UP              ,0x00000040 }, // Found @0xf864bbe4, levent 0x04
  28     { 0, KEY_RIGHT           ,0x00000080 }, // Found @0xf864bbec, levent 0x07
  29     { 0, KEY_VIDEO           ,0x00000100 },
  30     { 0, KEY_ZOOM_OUT        ,0x00008000 }, // Found @0xf864bc2c, levent 0x03
  31     { 0, KEY_ZOOM_IN         ,0x00010000 }, // Found @0xf864bc34, levent 0x02
  32 
  33 // Removed since it breaks when shooting with KEY_POWER pressed
  34 //    { 1, KEY_POWER           ,0x00400000 }, // Found @0xf864bc54, levent 0x100
  35     { 1, KEY_PLAYBACK        ,0x00800000 }, // Found @0xf864bc5c, levent 0x101
  36 
  37     { 2, KEY_SHOOT_FULL      ,0x000000c0 }, // Found @0xf864bc6c, levent 0x01
  38     { 2, KEY_SHOOT_FULL_ONLY ,0x00000080 }, // Found @0xf864bc6c, levent 0x01
  39     { 2, KEY_SHOOT_HALF      ,0x00000040 }, // Found @0xf864bc64, levent 0x00
  40     { 0, 0, 0 }
  41 };
  42 
  43 long __attribute__((naked,noinline)) wrap_kbd_p1_f()
  44 {
  45     asm volatile(
  46         "STMFD   SP!, {R1-R7,LR}\n"
  47         "MOV     R5, #0\n"
  48         //"BL      _kbd_read_keys \n"
  49         "BL     my_kbd_read_keys\n"
  50         "B       _kbd_p1_f_cont\n"
  51     );
  52     return 0; // shut up the compiler
  53 }
  54 
  55 void __attribute__((noinline)) mykbd_task()
  56 {
  57     while (physw_run){
  58         _SleepTask(physw_sleep_delay);
  59 
  60         if (wrap_kbd_p1_f() == 1){ // autorepeat ?
  61             _kbd_p2_f();
  62         }
  63     }
  64     _ExitTask();    
  65 }
  66 
  67 void my_kbd_read_keys() {
  68     kbd_update_key_state();
  69     kbd_update_physw_bits();
  70 }
  71 
  72 void kbd_fetch_data(long *dst)
  73 {
  74     _GetKbdState(dst);
  75     _kbd_read_keys_r2(dst);
  76 }
  77 
  78 
  79 // ========= Jog Dial ==============
  80 
  81 extern short* jog_position;
  82 extern short rear_dial_position;
  83 
  84 int jogdial_stopped=0;
  85 static short new_jogdial = 0, old_jogdial = 0;
  86 
  87 void jogdial_control(int n)
  88 {
  89     if (jogdial_stopped && !n)
  90     {
  91         jog_position[0] = jog_position[2] = rear_dial_position;   // Rear dial
  92     }
  93     jogdial_stopped = n;
  94 }
  95 
  96 
  97 long get_jogdial_direction(void)
  98 {
  99     old_jogdial = new_jogdial;
 100     new_jogdial = rear_dial_position;
 101 
 102     if      (old_jogdial < new_jogdial)     return JOGDIAL_LEFT;
 103     else if (old_jogdial > new_jogdial)     return JOGDIAL_RIGHT;
 104     else                                    return 0;
 105 }

/* [<][>][^][v][top][bottom][index][help] */