root/platform/g7x2/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. get_dial_hw_position
  5. get_jogdial_direction
  6. handle_jogdial
  7. jogdial_control
  8. my_kbd_read_keys
  9. kbd_fetch_data

   1 
   2 #include "lolevel.h"
   3 #include "platform.h"
   4 #include "keyboard.h"
   5 #include "kbd_common.h"
   6 
   7 long kbd_new_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
   8 long kbd_prev_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
   9 long kbd_mod_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
  10 
  11 extern void _GetKbdState(long*);
  12 
  13 int get_usb_bit()
  14 {
  15     long usb_physw[3];
  16     usb_physw[USB_IDX] = 0;
  17     _kbd_read_keys_r2(usb_physw);
  18     return ((usb_physw[USB_IDX] & USB_MASK)==USB_MASK);
  19 }
  20 
  21 // TODO:
  22 KeyMap keymap[] = {
  23     { 0, KEY_PLAYBACK        ,0x00008000 }, // Found @0xe05df0b0, levent 0x101
  24     { 0, KEY_VIDEO           ,0x00010000 }, // Found @0xe05df0b8, levent 0x02
  25     { 0, KEY_ZOOM_IN         ,0x00020000 }, // Found @0xe05df0c0, levent 0x03
  26     { 0, KEY_ZOOM_OUT        ,0x00040000 }, // Found @0xe05df0c8, levent 0x04
  27     { 0, KEY_SHOOT_FULL      ,0x00180000 }, // Found @0xe05df0d0, levent 0x01
  28     { 0, KEY_SHOOT_HALF      ,0x00100000 }, // Found @0xe05df0d8, levent 0x00
  29     { 0, KEY_SHOOT_FULL_ONLY ,0x00080000 }, // Found @0xe05df0d0, levent 0x01
  30     { 0, KEY_POWER           ,0x00200000 }, // Found @0xe05df0e0, levent 0x100
  31     { 0, KEY_WIFI            ,0x00400000 }, // Found @0xe05df0e8, levent 0x103
  32     { 2, KEY_MENU            ,0x00000020 },
  33     { 2, KEY_DISPLAY         ,0x00000040 }, // RING FUNC button
  34     { 2, KEY_UP              ,0x00000200 }, // Found @0xe05df158, levent 0x06
  35     { 2, KEY_DOWN            ,0x00000400 }, // Found @0xe05df160, levent 0x07
  36     { 2, KEY_RIGHT           ,0x00000800 }, // Found @0xe05df168, levent 0x09
  37     { 2, KEY_LEFT            ,0x00001000 }, // Found @0xe05df170, levent 0x08
  38     { 2, KEY_SET             ,0x00002000 }, // Found @0xe05df178, levent 0x0a
  39     { 0, 0, 0 }
  40 };
  41 
  42 long __attribute__((naked,noinline)) wrap_kbd_p1_f()
  43 {
  44     asm volatile(
  45         "push    {r1-r7, lr}\n"
  46         "movs    r4, #0\n"
  47         "bl      my_kbd_read_keys\n"
  48         "b       kbd_p1_f_cont_my\n"
  49     );
  50 
  51     return 0;
  52 }
  53 
  54 // no stack manipulation needed here, since we create the task directly
  55 void __attribute__((naked,noinline)) mykbd_task()
  56 {
  57     extern void kbd_p2_f_my();
  58 
  59     while (physw_run)
  60     {
  61         _SleepTask(physw_sleep_delay);
  62 
  63         if (wrap_kbd_p1_f() == 1)
  64         {
  65             kbd_p2_f_my();
  66         }
  67     }
  68 
  69     _ExitTask();
  70 }
  71 
  72 #define DIAL_HW_REAR  5     // Rear dial
  73 #define DIAL_HW_FRONT 4     // Lens control ring
  74 
  75 int jogdial_stopped = 0;
  76 extern long dial_positions[4];
  77 
  78 int get_dial_hw_position(int dial)
  79 {
  80     // mask low bits
  81     extern int _get_dial_hw_position(int dial);
  82     return _get_dial_hw_position(dial) & ~3;
  83 }
  84 
  85 long get_jogdial_direction(void)
  86 {
  87     static int new_jogdial = 0, old_jogdial = 0, new_frontdial = 0, old_frontdial = 0;
  88     
  89     old_jogdial = new_jogdial;
  90     new_jogdial = get_dial_hw_position(DIAL_HW_REAR);
  91 
  92     old_frontdial = new_frontdial;
  93     new_frontdial = get_dial_hw_position(DIAL_HW_FRONT);
  94 
  95     if (old_jogdial > new_jogdial) return JOGDIAL_LEFT;
  96     else if (old_jogdial < new_jogdial) return JOGDIAL_RIGHT;
  97     if (old_frontdial > new_frontdial) return FRONTDIAL_LEFT;  // counter clockwise with camera aimed away from you
  98     else if (old_frontdial < new_frontdial) return FRONTDIAL_RIGHT;
  99     else return 0;
 100 }
 101 
 102 int handle_jogdial()
 103 {
 104     // return 0 to prevent fw dial handler
 105     if (jogdial_stopped) {
 106         // update positions in RAM
 107         dial_positions[0] = dial_positions[2] = get_dial_hw_position(DIAL_HW_REAR);
 108         dial_positions[1] = dial_positions[3] = get_dial_hw_position(DIAL_HW_FRONT);
 109         return 0;
 110     }
 111     return 1;
 112 }
 113 
 114 void jogdial_control(int c)
 115 {
 116     jogdial_stopped = c;
 117 }
 118 
 119 int physw0_override;
 120 
 121 void my_kbd_read_keys()
 122 {
 123     if (kbd_update_key_state())
 124         physw0_override = physw_status[0];
 125     else
 126         physw0_override = -1;
 127     kbd_update_physw_bits();
 128 }
 129 
 130 void kbd_fetch_data(long *dst)
 131 {
 132     _GetKbdState(dst);
 133     _kbd_read_keys_r2(dst);
 134 }

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