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_counter
  6. get_jogdial_direction
  7. handle_jogdial
  8. jogdial_control
  9. my_kbd_read_keys
  10. 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     { 2, KEY_UP              ,0x00000200 }, // Found @0xe05df158, levent 0x06
  32     { 2, KEY_DOWN            ,0x00000400 }, // Found @0xe05df160, levent 0x07
  33     { 2, KEY_RIGHT           ,0x00000800 }, // Found @0xe05df168, levent 0x09
  34     { 2, KEY_LEFT            ,0x00001000 }, // Found @0xe05df170, levent 0x08
  35     { 2, KEY_SET             ,0x00002000 }, // Found @0xe05df178, levent 0x0a
  36 //    { 0, KEY_SHOOT_FULL_ONLY ,0x00000001 },
  37 //    { 0, KEY_ZOOM_OUT        ,0x00000002 },
  38 //    { 0, KEY_ZOOM_IN         ,0x00000004 },
  39 //    { 0, KEY_VIDEO           ,0x00000008 },
  40 //    { 0, KEY_MENU            ,0x00000010 },
  41 //    { 0, KEY_UP              ,0x00000020 },
  42 //    { 0, KEY_DOWN            ,0x00000040 },
  43 //    { 0, KEY_RIGHT           ,0x00000080 },
  44 //    { 0, KEY_LEFT            ,0x00000100 },
  45 //    { 0, KEY_SET             ,0x00000200 },
  46 //    { 0, KEY_ERASE           ,0x00000400 },
  47 //    { 0, KEY_PLAYBACK        ,0x00000800 },
  48 //    { 0, KEY_WIFI            ,0x00010000 },
  49 //    { 0, KEY_POWER           ,0x00020000 },
  50 //    { 0, KEY_SHOOT_HALF      ,0x00040000 },
  51 //    { 0, KEY_SHOOT_FULL      ,0x00040001 },
  52     { 1, KEY_DISPLAY         ,0x00000010 },
  53     { 0, 0, 0 }
  54 };
  55 
  56 long __attribute__((naked,noinline)) wrap_kbd_p1_f()
  57 {
  58     asm volatile(
  59         "push    {r1-r7, lr}\n"
  60         "movs    r4, #0\n"
  61         "bl      my_kbd_read_keys\n"
  62         "b       _kbd_p1_f_cont\n"
  63     );
  64 
  65     return 0;
  66 }
  67 
  68 // no stack manipulation needed here, since we create the task directly
  69 void __attribute__((naked,noinline)) mykbd_task()
  70 {
  71     extern void kbd_p2_f_my();
  72 
  73     while (physw_run)
  74     {
  75         _SleepTask(physw_sleep_delay);
  76 
  77         if (wrap_kbd_p1_f() == 1)
  78         {
  79 //            kbd_p2_f_my();
  80             _kbd_p2_f();
  81         }
  82     }
  83 
  84     _ExitTask();
  85 }
  86 
  87 int jogdial_stopped=0;
  88 
  89 int get_dial_hw_position(int dial)
  90 {
  91     // mask low bits
  92         extern int _get_dial_hw_position(int dial);
  93     return _get_dial_hw_position(dial)&~3;
  94 }
  95 
  96 // TODO:
  97 extern long dial_positions[6];
  98 
  99 int get_jogdial_counter()
 100 {
 101     int p = get_dial_hw_position(4);
 102     return p;
 103 }
 104 
 105 long get_jogdial_direction(void)
 106 {
 107     static int new_jogdial=0, old_jogdial=0 ;
 108 
 109     old_jogdial=new_jogdial;
 110     new_jogdial=get_jogdial_counter();
 111 
 112     if (old_jogdial>new_jogdial) return JOGDIAL_LEFT;
 113     else if (old_jogdial<new_jogdial) return JOGDIAL_RIGHT;
 114     else return 0;
 115 }
 116 
 117 int handle_jogdial()
 118 {
 119     // return 0 to prevent fw dial handler
 120     if (jogdial_stopped)
 121     {
 122         // update positions in RAM
 123         dial_positions[0] = dial_positions[3] = get_jogdial_counter();
 124         return 0;
 125     }
 126     return 1;
 127 }
 128 
 129 void jogdial_control(int c)
 130 {
 131     jogdial_stopped = c;
 132 }
 133 
 134 void my_kbd_read_keys()
 135 {
 136     kbd_update_key_state();
 137     kbd_update_physw_bits();
 138 }
 139 
 140 void kbd_fetch_data(long *dst)
 141 {
 142     _GetKbdState(dst);
 143     _kbd_read_keys_r2(dst);
 144 }

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