1 | #include "../globals.h"
|
---|
2 | //#include "../reader-common.h"
|
---|
3 | #include "icc_async.h"
|
---|
4 | #include "io_serial.h"
|
---|
5 | #include <termios.h>
|
---|
6 |
|
---|
7 | #define ACK 0x06
|
---|
8 |
|
---|
9 | // Common command for AD-Teknik readers
|
---|
10 | static const BYTE fw_version[] = {0x2a, 0x41};
|
---|
11 |
|
---|
12 | // Commands for AD-Teknik MP3.6 and MP3.6
|
---|
13 | static const BYTE set_vpp[] = {0x2a, 0x42};
|
---|
14 | static const BYTE set_data[] = {0x2a, 0x43};
|
---|
15 | static const BYTE set_oscillator[] = {0x2a, 0x5e};
|
---|
16 | static const BYTE terminate_com[] = {0x2a, 0x7b};
|
---|
17 | static const BYTE transthrough_mode[] = {0x2a, 0x7c};
|
---|
18 | static const BYTE phoenix_mode[] = {0x2a, 0x7d};
|
---|
19 | static const BYTE smartmouse_mode[] = {0x2a, 0x7e};
|
---|
20 | static const BYTE phoenix_6mhz_mode[] = {0x2a, 0x9a};
|
---|
21 | static const BYTE smartmouse_6mhz_mode[] = {0x2a, 0x9b};
|
---|
22 |
|
---|
23 | // Commands for AD-Teknik USB Phoenix
|
---|
24 | static const BYTE set_mode_osc[] = {0x2a, 0x42};
|
---|
25 | static const BYTE exit_program_mode[] = {0x2a, 0x43};
|
---|
26 |
|
---|
27 | static const struct product { BYTE code; const char* product_name; } product_codes[] = {
|
---|
28 | {0x10, "USB Phoenix"},
|
---|
29 | {0x40, "MP3.4"},
|
---|
30 | {0x41, "MP3.5"},
|
---|
31 | {0x42, "MP3.6 USB"}};
|
---|
32 |
|
---|
33 | BYTE current_product;
|
---|
34 |
|
---|
35 | static int MP35_product_info(BYTE high, BYTE low, BYTE code)
|
---|
36 | {
|
---|
37 | int i;
|
---|
38 |
|
---|
39 | for(i = 0; i < (int)(sizeof(product_codes) / sizeof(struct product)); i++)
|
---|
40 | {
|
---|
41 | if(product_codes[i].code == code)
|
---|
42 | {
|
---|
43 | cs_log("MP35_Init: %s - FW:%02d.%02d", product_codes[i].product_name, high, low);
|
---|
44 | return OK;
|
---|
45 | }
|
---|
46 | }
|
---|
47 |
|
---|
48 | return ERROR;
|
---|
49 | }
|
---|
50 |
|
---|
51 | int MP35_Init(struct s_reader * reader)
|
---|
52 | {
|
---|
53 | BYTE rec_buf[32];
|
---|
54 | BYTE parameter;
|
---|
55 | int original_mhz;
|
---|
56 |
|
---|
57 | current_product = 0;
|
---|
58 | memset(rec_buf, 0x00, sizeof(rec_buf));
|
---|
59 | call(IO_Serial_InitPnP (reader));
|
---|
60 | IO_Serial_Flush(reader);
|
---|
61 |
|
---|
62 | cs_debug_mask (D_IFD, "IFD: Initializing MP35 reader %s", reader->label);
|
---|
63 |
|
---|
64 | original_mhz = reader->mhz; // MP3.5 commands should be always be written using 9600 baud at 3.58MHz
|
---|
65 | reader->mhz = 357;
|
---|
66 |
|
---|
67 | call(IO_Serial_SetParams (reader, 9600, 8, PARITY_NONE, 1, IO_SERIAL_HIGH, IO_SERIAL_HIGH));
|
---|
68 | IO_Serial_Sendbreak(reader, 1200);
|
---|
69 | IO_Serial_DTR_Clr(reader);
|
---|
70 | IO_Serial_Flush(reader);
|
---|
71 |
|
---|
72 | IO_Serial_DTR_Set(reader);
|
---|
73 |
|
---|
74 | call(IO_Serial_Write(reader, 0, 2, fw_version));
|
---|
75 | call(IO_Serial_Read(reader, 200, 4, rec_buf));
|
---|
76 | if(rec_buf[3] != ACK)
|
---|
77 | {
|
---|
78 | cs_debug_mask (D_IFD, "IFD: Failed MP35 command: fw_version");
|
---|
79 | return ERROR;
|
---|
80 | }
|
---|
81 |
|
---|
82 | if(MP35_product_info(rec_buf[1], rec_buf[0], rec_buf[2]) != OK)
|
---|
83 | {
|
---|
84 | cs_log("MP35_Init, unknown product code");
|
---|
85 | return ERROR;
|
---|
86 | }
|
---|
87 | current_product = rec_buf[2];
|
---|
88 | /*
|
---|
89 | call(IO_Serial_Write(reader, 0, 2, terminate_com));
|
---|
90 | call(IO_Serial_Read(reader, 200, 1, rec_buf));
|
---|
91 | if(rec_buf[0] != ACK)
|
---|
92 | {
|
---|
93 | cs_debug_mask (D_IFD, "IFD: Failed MP35 command: terminate_com");
|
---|
94 | return ERROR;
|
---|
95 | }
|
---|
96 |
|
---|
97 | parameter = 0x01;
|
---|
98 | call(IO_Serial_Write(reader, 0, 2, set_vpp));
|
---|
99 | call(IO_Serial_Write(reader, 0, 1, ¶meter));
|
---|
100 | call(IO_Serial_Read(reader, 200, 1, rec_buf));
|
---|
101 | if(rec_buf[0] != ACK)
|
---|
102 | {
|
---|
103 | cs_debug_mask (D_IFD, "IFD: Failed MP35 command: set_vpp");
|
---|
104 | return ERROR;
|
---|
105 | }
|
---|
106 |
|
---|
107 | parameter = 0x02;
|
---|
108 | call(IO_Serial_Write(reader, 0, 2, set_data));
|
---|
109 | call(IO_Serial_Write(reader, 0, 1, ¶meter));
|
---|
110 | call(IO_Serial_Read(reader, 200, 1, rec_buf));
|
---|
111 | if(rec_buf[0] != ACK)
|
---|
112 | {
|
---|
113 | cs_debug_mask (D_IFD, "IFD: Failed MP35 command: set_data");
|
---|
114 | return ERROR;
|
---|
115 | }
|
---|
116 |
|
---|
117 | parameter = 0x01;
|
---|
118 | call(IO_Serial_Write(reader, 0, 2, set_oscillator));
|
---|
119 | call(IO_Serial_Write(reader, 0, 1, ¶meter));
|
---|
120 | call(IO_Serial_Read(reader, 200, 1, rec_buf));
|
---|
121 | if(rec_buf[0] != ACK)
|
---|
122 | {
|
---|
123 | cs_debug_mask (D_IFD, "IFD: Failed MP35 command: set_oscillator");
|
---|
124 | return ERROR;
|
---|
125 | }
|
---|
126 |
|
---|
127 | call(IO_Serial_SetParams (reader, 9600, 8, PARITY_NONE, 1, IO_SERIAL_HIGH, IO_SERIAL_LOW));
|
---|
128 |
|
---|
129 | call(IO_Serial_Write(reader, 0, 2, transthrough_mode));
|
---|
130 | */
|
---|
131 |
|
---|
132 | if(current_product == 0x10) // USB Phoenix
|
---|
133 | {
|
---|
134 | if(original_mhz == 357)
|
---|
135 | {
|
---|
136 | cs_log("MP35_Init, Using oscillator 1 (3.57MHz)");
|
---|
137 | parameter = 0x01;
|
---|
138 | }
|
---|
139 | else if(original_mhz == 368)
|
---|
140 | {
|
---|
141 | cs_log("MP35_Init, Using oscillator 2 (3.68MHz)");
|
---|
142 | parameter = 0x02;
|
---|
143 | }
|
---|
144 | else if(original_mhz == 600)
|
---|
145 | {
|
---|
146 | cs_log("MP35_Init, Using oscillator 3 (6.00MHz)");
|
---|
147 | parameter = 0x03;
|
---|
148 | }
|
---|
149 | else
|
---|
150 | {
|
---|
151 | cs_log("MP35_Init, MP35 support only mhz=357, mhz=368 or mhz=600");
|
---|
152 | cs_log("MP35_Init, Forced oscillator 1 (3.57MHz)");
|
---|
153 | parameter = 0x01;
|
---|
154 | original_mhz = 357;
|
---|
155 | }
|
---|
156 | call(IO_Serial_Write(reader, 0, 2, set_mode_osc));
|
---|
157 | call(IO_Serial_Write(reader, 0, 1, ¶meter));
|
---|
158 | call(IO_Serial_Read(reader, 200, 1, rec_buf)); // Read ACK from previous command
|
---|
159 | if(rec_buf[0] != ACK)
|
---|
160 | {
|
---|
161 | cs_debug_mask (D_IFD, "IFD: Failed MP35 command: set_mode_osc");
|
---|
162 | return ERROR;
|
---|
163 | }
|
---|
164 | cs_log("MP35_Init, Leaving programming mode");
|
---|
165 | call(IO_Serial_Write(reader, 0, 2, exit_program_mode));
|
---|
166 | call(IO_Serial_Read(reader, 200, 1, rec_buf));
|
---|
167 | if(rec_buf[0] != ACK)
|
---|
168 | {
|
---|
169 | cs_debug_mask (D_IFD, "IFD: Failed MP35 command: exit_program_mode");
|
---|
170 | return ERROR;
|
---|
171 | }
|
---|
172 | }
|
---|
173 | else //MP3.5 or MP3.6
|
---|
174 | {
|
---|
175 | if(original_mhz == 357)
|
---|
176 | {
|
---|
177 | cs_log("MP35_Init, Using oscillator 1 (3.57MHz)");
|
---|
178 | call(IO_Serial_Write(reader, 0, 2, phoenix_mode));
|
---|
179 | }
|
---|
180 | else if(original_mhz == 600)
|
---|
181 | {
|
---|
182 | cs_log("MP35_Init, Using oscillator 2 (6.00MHz)");
|
---|
183 | call(IO_Serial_Write(reader, 0, 2, phoenix_6mhz_mode));
|
---|
184 | }
|
---|
185 | else
|
---|
186 | {
|
---|
187 | cs_log("MP35_Init, MP35 support only mhz=357 or mhz=600");
|
---|
188 | cs_log("MP35_Init, Forced oscillator 1 (3.57MHz)");
|
---|
189 | call(IO_Serial_Write(reader, 0, 2, phoenix_mode));
|
---|
190 | original_mhz = 357;
|
---|
191 | }
|
---|
192 | }
|
---|
193 |
|
---|
194 | reader->mhz = original_mhz; // We might have switched oscillator here
|
---|
195 |
|
---|
196 | IO_Serial_Flush(reader);
|
---|
197 |
|
---|
198 | return OK;
|
---|
199 | }
|
---|
200 |
|
---|
201 | int MP35_Close(struct s_reader * reader)
|
---|
202 | {
|
---|
203 | cs_debug_mask (D_IFD, "IFD: Closing MP35 device %s", reader->device);
|
---|
204 |
|
---|
205 | if(current_product != 0x10) // USB Phoenix
|
---|
206 | {
|
---|
207 | IO_Serial_Sendbreak(reader, 1200);
|
---|
208 | IO_Serial_DTR_Clr(reader);
|
---|
209 | }
|
---|
210 |
|
---|
211 | IO_Serial_Close(reader);
|
---|
212 |
|
---|
213 | return OK;
|
---|
214 | }
|
---|