root/platform/sx500is/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. jogdial_control
  5. my_kbd_read_keys
  6. kbd_fetch_data
  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     long usb_physw[3];
  14     usb_physw[USB_IDX] = 0;
  15     _kbd_read_keys_r2(usb_physw);
  16     return(( usb_physw[USB_IDX] & USB_MASK)==USB_MASK) ;
  17 }
  18 
  19 KeyMap keymap[] = {
  20     // Order IS important. kbd_get_pressed_key will walk down this table
  21     // and take the first matching mask. Notice that KEY_SHOOT_HALF is
  22     // always pressed if KEY_SHOOT_FULL is. --MarcusSt
  23     { 0, KEY_ERASE           ,0x00080000 }, // Found @0xff39e3a8, levent 0x0a
  24     { 0, KEY_DISPLAY         ,0x00040000 }, // Found @0xff39e3a8, levent 0x0a
  25     { 0, KEY_VIDEO           ,0x00020000 }, // Found @0xff39e3a8, levent 0x0a
  26     { 0, KEY_LEFT            ,0x00010000 }, // Found @0xff39e398, levent 0x06
  27     { 0, KEY_MENU            ,0x00008000 }, // Found @0xff39e390, levent 0x09
  28     { 0, KEY_SET             ,0x00001000 }, // Found @0xff39e378, levent 0x08
  29     { 0, KEY_RIGHT           ,0x00002000 }, // Found @0xff39e380, levent 0x07
  30     { 0, KEY_DOWN            ,0x00000800 }, // Found @0xff39e370, levent 0x05
  31     { 0, KEY_UP              ,0x00000400 }, // Found @0xff39e368, levent 0x04
  32     { 2, KEY_SHOOT_FULL      ,0x00000600 }, // Found @0xff39e3e0, levent 0x01
  33     { 2, KEY_SHOOT_FULL_ONLY ,0x00000400 }, // Found @0xff39e3e0, levent 0x01
  34     { 2, KEY_SHOOT_HALF      ,0x00000200 }, // Found @0xff39e3d8, levent 0x00
  35     { 2, KEY_PLAYBACK        ,0x00000008 }, // Found @0xff39e3d0, levent 0x101
  36     { 2, KEY_POWER           ,0x00000002 }, // Found @0xff39e3c8, levent 0x100
  37     { 0, 0, 0 }
  38 };
  39 
  40 
  41 int jogdial_stopped=0;
  42 
  43 long __attribute__((naked,noinline)) wrap_kbd_p1_f() {
  44 
  45     //SX500IS 100C @ 0xff019558
  46     asm volatile(
  47                 "STMFD   SP!, {R1-R7,LR}\n"
  48                 "MOV     R5, #0\n"
  49                 "BL      my_kbd_read_keys\n"
  50                 "B       _kbd_p1_f_cont\n"
  51     );
  52 
  53     return 0;
  54 }
  55 
  56 // no stack manipulation needed here, since we create the task directly
  57 void __attribute__((noinline)) mykbd_task() {
  58     while (physw_run) {
  59         _SleepTask(physw_sleep_delay);
  60 
  61         if (wrap_kbd_p1_f() == 1) {             // autorepeat ?
  62             _kbd_p2_f();
  63         }
  64     }
  65 
  66     _ExitTask();
  67 }
  68 
  69 // Pointer to stack location where jogdial task records previous and current
  70 // jogdial positions
  71 extern short* jog_position;
  72 extern short rear_dial_position;
  73 
  74 void jogdial_control(int n) {
  75     if (jogdial_stopped && !n) {
  76         // If re-enabling jogdial set the task code current & previous positions to the actual
  77         // dial positions so that the change won't get processed by the firmware
  78         jog_position[0] = jog_position[2] = rear_dial_position;   // Rear dial
  79     }
  80     jogdial_stopped = n;
  81 }
  82 
  83 void my_kbd_read_keys()
  84 {
  85     kbd_update_key_state();
  86     kbd_update_physw_bits();
  87 }
  88 
  89 void kbd_fetch_data(long *dst)
  90 {
  91     _GetKbdState(dst);
  92     _kbd_read_keys_r2(dst);
  93 }
  94 
  95 static short new_jogdial = 0, old_jogdial = 0;
  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] */