root/platform/g15/kbd.c

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

DEFINITIONS

This source file includes following definitions.
  1. get_usb_bit
  2. mykbd_task
  3. wrap_kbd_p1_f
  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 {
  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_METERING        ,0x00000400 }, 
  22     { 0, KEY_ERASE           ,0x00010000 }, 
  23     { 0, KEY_AE_LOCK         ,0x00020000 }, 
  24     { 0, KEY_SET             ,0x00000800 }, // Found @0xff4a0d2c, levent 0x08
  25     { 0, KEY_RIGHT           ,0x00001000 }, // Found @0xff4a0d34, levent 0x07
  26     { 0, KEY_DOWN            ,0x00002000 }, // Found @0xff4a0d3c, levent 0x05
  27     { 0, KEY_MENU            ,0x00004000 }, // Found @0xff4a0d44, levent 0x09
  28     { 0, KEY_LEFT            ,0x00008000 }, // Found @0xff4a0d4c, levent 0x06
  29     { 0, KEY_UP              ,0x00040000 }, // Found @0xff4a0d64, levent 0x04
  30     { 0, KEY_ZOOM_IN         ,0x00100000 }, // Found @0xff4a0d74, levent 0x02
  31     { 0, KEY_ZOOM_OUT        ,0x00200000 }, // Found @0xff4a0d7c, levent 0x03
  32     { 0, KEY_VIDEO           ,0x00080000 },
  33     { 1, KEY_PRINT           ,0x00800000 }, // Shortcut button
  34     { 2, KEY_POWER           ,0x00000800 }, // Found @0xff4a0dc4, levent 0x100
  35     { 2, KEY_PLAYBACK        ,0x00008000 }, // Found @0xff4a0dcc, levent 0x101
  36     { 2, KEY_SHOOT_FULL      ,0x000c0000 }, // Found @0xff4a0ddc, levent 0x01
  37     { 2, KEY_SHOOT_FULL_ONLY ,0x00080000 }, // Found @0xff4a0ddc, levent 0x01
  38     { 2, KEY_SHOOT_HALF      ,0x00040000 }, // Found @0xff4a0dd4, levent 0x00
  39     { 0, 0, 0 }
  40 };
  41 
  42 long __attribute__((naked)) wrap_kbd_p1_f();
  43 
  44 // no stack manipulation needed here, since we create the task directly
  45 void __attribute__((noinline))
  46 mykbd_task()
  47 {
  48         while (physw_run){
  49                 _SleepTask(physw_sleep_delay);
  50 
  51                 if (wrap_kbd_p1_f() == 1){ // autorepeat ?
  52                         _kbd_p2_f();
  53                 }
  54         }
  55 
  56     _ExitTask();
  57 }
  58 
  59 long __attribute__((naked,noinline)) wrap_kbd_p1_f()
  60 {
  61         asm volatile(
  62                 "STMFD   SP!, {R1-R7,LR}\n"
  63                 "MOV     R5, #0\n"
  64                 //"BL      _kbd_read_keys \n"
  65                 "BL             my_kbd_read_keys\n"
  66                 "B       _kbd_p1_f_cont\n"
  67         );
  68         return 0; // shut up the compiler
  69 }
  70 
  71 // Set to 1 to disable jogdial events from being processed in firmware
  72 int jogdial_stopped=0;
  73 
  74 // Pointer to stack location where jogdial task records previous and current
  75 // jogdial positions
  76 extern short* jog_position;
  77 extern short rear_dial_position;
  78 
  79 void jogdial_control(int n)
  80 {
  81     if (jogdial_stopped && !n)
  82     {
  83         // If re-enabling jogdial set the task code current & previous positions to the actual
  84         // dial positions so that the change won't get processed by the firmware
  85         jog_position[0] = jog_position[2] = rear_dial_position;   // Rear dial
  86     }
  87     jogdial_stopped = n;
  88 }
  89 
  90 void my_kbd_read_keys()
  91 {
  92     kbd_update_key_state();
  93     kbd_update_physw_bits();
  94 }
  95 
  96 void kbd_fetch_data(long *dst)
  97 {
  98     _GetKbdState(dst);
  99     _kbd_read_keys_r2(dst);
 100 }
 101 
 102 /****************/
 103 
 104 
 105 static short new_jogdial = 0, old_jogdial = 0;
 106 
 107 long get_jogdial_direction(void)
 108 {
 109     old_jogdial = new_jogdial;
 110     new_jogdial = rear_dial_position;
 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 }

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