This source file includes following definitions.
- get_usb_bit
- wrap_kbd_p1_f
- mykbd_task
- get_dial_hw_position
- get_jogdial_direction
- handle_jogdial
- jogdial_control
- my_kbd_read_keys
- 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
22 KeyMap keymap[] = {
23 { 0, KEY_PLAYBACK ,0x00008000 },
24 { 0, KEY_VIDEO ,0x00010000 },
25 { 0, KEY_ZOOM_IN ,0x00020000 },
26 { 0, KEY_ZOOM_OUT ,0x00040000 },
27 { 0, KEY_SHOOT_FULL ,0x00180000 },
28 { 0, KEY_SHOOT_HALF ,0x00100000 },
29 { 0, KEY_SHOOT_FULL_ONLY ,0x00080000 },
30 { 0, KEY_POWER ,0x00200000 },
31 { 0, KEY_WIFI ,0x00400000 },
32 { 2, KEY_MENU ,0x00000020 },
33 { 2, KEY_DISPLAY ,0x00000040 },
34 { 2, KEY_UP ,0x00000200 },
35 { 2, KEY_DOWN ,0x00000400 },
36 { 2, KEY_RIGHT ,0x00000800 },
37 { 2, KEY_LEFT ,0x00001000 },
38 { 2, KEY_SET ,0x00002000 },
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
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
73 #define DIAL_HW_FRONT 4
74
75 int jogdial_stopped = 0;
76 extern long dial_positions[4];
77
78 int get_dial_hw_position(int dial)
79 {
80
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;
98 else if (old_frontdial < new_frontdial) return FRONTDIAL_RIGHT;
99 else return 0;
100 }
101
102 int handle_jogdial()
103 {
104
105 if (jogdial_stopped) {
106
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 }