This source file includes following definitions.
- get_usb_bit
- kbd_fetch_data
- my_kbd_read_keys
- wrap_kbd_p1_f
- mykbd_task
- jogdial_control
- get_jogdial_direction
1 #include "lolevel.h"
2 #include "platform.h"
3 #include "core.h"
4 #include "conf.h"
5 #include "kbd_common.h"
6
7 KeyMap keymap[] = {
8
9 { 0, KEY_ZOOM_IN , 0x00000020 },
10 { 0, KEY_PRINT , 0x00000400 },
11 { 0, KEY_ZOOM_OUT , 0x00000800 },
12 { 0, KEY_LEFT , 0x00001000 },
13 { 0, KEY_SET , 0x00002000 },
14 { 0, KEY_RIGHT , 0x00004000 },
15 { 0, KEY_DOWN , 0x00008000 },
16 { 0, KEY_UP , 0x00010000 },
17 { 0, KEY_METERING , 0x00040000 },
18 { 0, KEY_ERASE , 0x00080000 },
19 { 0, KEY_DISPLAY , 0x00100000 },
20 { 0, KEY_MENU , 0x00200000 },
21 { 0, KEY_AE_LOCK , 0x00400000 },
22
23 { 2, KEY_SHOOT_FULL , 0x00000003 },
24 { 2, KEY_SHOOT_FULL_ONLY, 0x00000002 },
25 { 2, KEY_SHOOT_HALF , 0x00000001 },
26
27
28
29
30 { 0, 0, 0 }
31 };
32
33 long kbd_new_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
34 long kbd_prev_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
35 long kbd_mod_state[3] = { 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
36
37 extern void _GetKbdState(long*);
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56 int get_usb_bit()
57 {
58 long usb_physw[3];
59 usb_physw[USB_IDX] = 0;
60 _kbd_read_keys_r2(usb_physw);
61 return(( usb_physw[USB_IDX] & USB_MASK)==USB_MASK) ;
62 }
63
64 void kbd_fetch_data(long *dst)
65 {
66 _GetKbdState(dst);
67 _kbd_read_keys_r2(dst);
68 }
69
70 void my_kbd_read_keys()
71 {
72 kbd_update_key_state();
73 kbd_update_physw_bits();
74 }
75
76 long __attribute__((naked,noinline)) wrap_kbd_p1_f()
77 {
78 asm volatile(
79 "STMFD SP!, {R1-R5,LR}\n"
80 "MOV R4, #0\n"
81
82 "BL my_kbd_read_keys\n"
83 "B _kbd_p1_f_cont\n"
84 );
85 return 0;
86 }
87
88
89 void __attribute__((naked,noinline))
90 mykbd_task()
91 {
92 while (physw_run){
93 _SleepTask(physw_sleep_delay);
94
95 if (wrap_kbd_p1_f() == 1){
96 _kbd_p2_f();
97 }
98 }
99
100 _ExitTask();
101 }
102
103
104 int jogdial_stopped=0;
105
106
107
108 extern short* jog_position;
109 extern short rear_dial_position, front_dial_position;
110
111 void jogdial_control(int n)
112 {
113 if (jogdial_stopped && !n)
114 {
115
116
117 jog_position[0] = jog_position[2] = rear_dial_position;
118 jog_position[1] = jog_position[3] = front_dial_position;
119 }
120 jogdial_stopped = n;
121 }
122
123 static short new_jogdial = 0, old_jogdial = 0, new_frontdial = 0, old_frontdial = 0;
124
125 long get_jogdial_direction(void)
126 {
127 old_jogdial = new_jogdial;
128 new_jogdial = rear_dial_position;
129
130 old_frontdial = new_frontdial;
131 new_frontdial = front_dial_position;
132
133 if (old_jogdial > new_jogdial) return JOGDIAL_LEFT;
134 else if (old_jogdial < new_jogdial) return JOGDIAL_RIGHT;
135 else if (old_frontdial > new_frontdial) return FRONTDIAL_LEFT;
136 else if (old_frontdial < new_frontdial) return FRONTDIAL_RIGHT;
137 else return 0;
138 }