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