This source file includes following definitions.
- get_usb_bit
- mykbd_task_proceed
- mykbd_task
- wrap_kbd_p1_f
- my_kbd_read_keys
- kbd_fetch_data
- jogdial_control
- Get_JogDial
- 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 #define NEW_SS (0x2000)
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 static char kbd_stack[NEW_SS];
21
22 KeyMap keymap[] = {
23
24
25
26 { 1, KEY_PRINT , 0x01000000 },
27 { 1, KEY_MENU , 0x08000000 },
28 { 1, KEY_UP , 0x00080000 },
29 { 1, KEY_DOWN , 0x00020000 },
30 { 1, KEY_LEFT , 0x00040000 },
31 { 1, KEY_RIGHT , 0x00010000 },
32 { 1, KEY_SET , 0x00100000 },
33 { 1, KEY_FACE , 0x10000000 },
34 { 1, KEY_ERASE , 0x04000000 },
35 { 1, KEY_DISPLAY , 0x02000000 },
36 { 1, KEY_ZOOM_IN , 0x00000100 },
37 { 1, KEY_ZOOM_OUT , 0x00000200 },
38
39 { 0, KEY_SHOOT_FULL, 0x0000000C },
40 { 0, KEY_SHOOT_FULL_ONLY, 0x00000008 },
41 { 0, KEY_SHOOT_HALF, 0x00000004 },
42 { 0 }
43 };
44
45 extern void _GetKbdState(long *dst);
46
47 long __attribute__((naked)) wrap_kbd_p1_f();
48
49 static void __attribute__((noinline)) mykbd_task_proceed()
50 {
51 while (physw_run){
52 _SleepTask(10);
53 if (wrap_kbd_p1_f() == 1){
54 _kbd_p2_f();
55 }
56 }
57 }
58
59 void __attribute__((naked,noinline)) mykbd_task()
60 {
61
62
63
64
65
66
67
68
69
70
71 register int i;
72 register long *newstack;
73
74 newstack = (void*)kbd_stack;
75
76 for (i=0;i<NEW_SS/4;i++)
77 newstack[i]=0xdededede;
78
79 asm volatile (
80 "MOV SP, %0"
81 :: "r"(((char*)newstack)+NEW_SS)
82 : "memory"
83 );
84
85 mykbd_task_proceed();
86
87
88
89
90 _ExitTask();
91 }
92
93
94 long __attribute__((naked,noinline)) wrap_kbd_p1_f()
95 {
96
97 asm volatile(
98 "STMFD SP!, {R1-R5,LR}\n"
99 "MOV R4, #0\n"
100
101 "BL my_kbd_read_keys\n"
102 "B _kbd_p1_f_cont\n"
103 );
104 return 0;
105 }
106
107
108 int jogdial_stopped=0;
109
110 void my_kbd_read_keys()
111 {
112 kbd_update_key_state();
113 kbd_update_physw_bits();
114 }
115
116 void kbd_fetch_data(long *dst)
117 {
118 _kbd_pwr_on();
119 _GetKbdState(dst);
120 _kbd_read_keys_r2(dst);
121 _kbd_pwr_off();
122 }
123
124
125
126 void jogdial_control(int n) {
127
128
129
130
131
132
133
134
135 jogdial_stopped = n;
136 }
137
138 static int new_jogdial=0, old_jogdial=0;
139
140 int Get_JogDial(void){
141
142
143
144
145
146 return (*(int*)0xC0240104)>>16;
147
148 }
149
150 long get_jogdial_direction(void) {
151 old_jogdial=new_jogdial;
152 new_jogdial=Get_JogDial();
153 if (old_jogdial<new_jogdial) return JOGDIAL_RIGHT;
154 else if (old_jogdial>new_jogdial) return JOGDIAL_LEFT;
155 else return 0;
156 }