Line | Branch | Exec | Source |
---|---|---|---|
1 | /* | ||
2 | * Goodix Moc driver for libfprint | ||
3 | * Copyright (C) 2019 Shenzhen Goodix Technology Co., Ltd. | ||
4 | * | ||
5 | * This library is free software; you can redistribute it and/or | ||
6 | * modify it under the terms of the GNU Lesser General Public | ||
7 | * License as published by the Free Software Foundation; either | ||
8 | * version 2.1 of the License, or (at your option) any later version. | ||
9 | * | ||
10 | * This library is distributed in the hope that it will be useful, | ||
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
13 | * Lesser General Public License for more details. | ||
14 | * | ||
15 | * You should have received a copy of the GNU Lesser General Public | ||
16 | * License along with this library; if not, write to the Free Software | ||
17 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA | ||
18 | */ | ||
19 | |||
20 | #include <glib.h> | ||
21 | #include <stdint.h> | ||
22 | |||
23 | #include "goodix_proto.h" | ||
24 | |||
25 | /* | ||
26 | * Crc functions | ||
27 | */ | ||
28 | |||
29 | #define WIDTH (8 * sizeof (uint32_t)) | ||
30 | #define FINAL_XOR_VALUE 0xFFFFFFFF | ||
31 | #define REFLECT_DATA(X) ((uint8_t) reflect ((X), 8)) | ||
32 | #define REFLECT_REMAINDER(X) ((unsigned int) reflect ((X), WIDTH)) | ||
33 | |||
34 | |||
35 | uint8_t | ||
36 | 55 | gx_proto_crc8_calc (uint8_t *lubp_date, uint32_t lui_len) | |
37 | { | ||
38 | 55 | const uint8_t *data = lubp_date; | |
39 | 55 | unsigned int crc = 0; | |
40 | 55 | int i, j; | |
41 | |||
42 |
2/2✓ Branch 0 taken 330 times.
✓ Branch 1 taken 55 times.
|
385 | for (j = lui_len; j; j--, data++) |
43 | { | ||
44 | 330 | crc ^= (*data << 8); | |
45 |
2/2✓ Branch 0 taken 2640 times.
✓ Branch 1 taken 330 times.
|
2970 | for (i = 8; i; i--) |
46 | { | ||
47 |
2/2✓ Branch 0 taken 1239 times.
✓ Branch 1 taken 1401 times.
|
2640 | if (crc & 0x8000) |
48 | 1239 | crc ^= (0x1070 << 3); | |
49 | 2640 | crc <<= 1; | |
50 | } | ||
51 | } | ||
52 | |||
53 | 55 | crc >>= 8; | |
54 | 55 | crc = ~crc; | |
55 | 55 | return (uint8_t) crc; | |
56 | } | ||
57 | |||
58 | typedef struct | ||
59 | { | ||
60 | uint32_t crc; | ||
61 | } gf_crc32_context; | ||
62 | |||
63 | static uint32_t s_crc_table[256] = | ||
64 | { 0x0, 0x4c11db7, 0x9823b6e, 0xd4326d9, 0x130476dc, 0x17c56b6b, 0x1a864db2, 0x1e475005, | ||
65 | 0x2608edb8, 0x22c9f00f, 0x2f8ad6d6, 0x2b4bcb61, 0x350c9b64, 0x31cd86d3, 0x3c8ea00a, 0x384fbdbd, | ||
66 | 0x4c11db70, 0x48d0c6c7, 0x4593e01e, 0x4152fda9, 0x5f15adac, 0x5bd4b01b, 0x569796c2, 0x52568b75, | ||
67 | 0x6a1936c8, 0x6ed82b7f, 0x639b0da6, 0x675a1011, 0x791d4014, 0x7ddc5da3, 0x709f7b7a, 0x745e66cd, | ||
68 | 0x9823b6e0, 0x9ce2ab57, 0x91a18d8e, 0x95609039, 0x8b27c03c, 0x8fe6dd8b, 0x82a5fb52, 0x8664e6e5, | ||
69 | 0xbe2b5b58, 0xbaea46ef, 0xb7a96036, 0xb3687d81, 0xad2f2d84, 0xa9ee3033, 0xa4ad16ea, 0xa06c0b5d, | ||
70 | 0xd4326d90, 0xd0f37027, 0xddb056fe, 0xd9714b49, 0xc7361b4c, 0xc3f706fb, 0xceb42022, 0xca753d95, | ||
71 | 0xf23a8028, 0xf6fb9d9f, 0xfbb8bb46, 0xff79a6f1, 0xe13ef6f4, 0xe5ffeb43, 0xe8bccd9a, 0xec7dd02d, | ||
72 | 0x34867077, 0x30476dc0, 0x3d044b19, 0x39c556ae, 0x278206ab, 0x23431b1c, 0x2e003dc5, 0x2ac12072, | ||
73 | 0x128e9dcf, 0x164f8078, 0x1b0ca6a1, 0x1fcdbb16, 0x18aeb13, 0x54bf6a4, 0x808d07d, 0xcc9cdca, | ||
74 | 0x7897ab07, 0x7c56b6b0, 0x71159069, 0x75d48dde, 0x6b93dddb, 0x6f52c06c, 0x6211e6b5, 0x66d0fb02, | ||
75 | 0x5e9f46bf, 0x5a5e5b08, 0x571d7dd1, 0x53dc6066, 0x4d9b3063, 0x495a2dd4, 0x44190b0d, 0x40d816ba, | ||
76 | 0xaca5c697, 0xa864db20, 0xa527fdf9, 0xa1e6e04e, 0xbfa1b04b, 0xbb60adfc, 0xb6238b25, 0xb2e29692, | ||
77 | 0x8aad2b2f, 0x8e6c3698, 0x832f1041, 0x87ee0df6, 0x99a95df3, 0x9d684044, 0x902b669d, 0x94ea7b2a, | ||
78 | 0xe0b41de7, 0xe4750050, 0xe9362689, 0xedf73b3e, 0xf3b06b3b, 0xf771768c, 0xfa325055, 0xfef34de2, | ||
79 | 0xc6bcf05f, 0xc27dede8, 0xcf3ecb31, 0xcbffd686, 0xd5b88683, 0xd1799b34, 0xdc3abded, 0xd8fba05a, | ||
80 | 0x690ce0ee, 0x6dcdfd59, 0x608edb80, 0x644fc637, 0x7a089632, 0x7ec98b85, 0x738aad5c, 0x774bb0eb, | ||
81 | 0x4f040d56, 0x4bc510e1, 0x46863638, 0x42472b8f, 0x5c007b8a, 0x58c1663d, 0x558240e4, 0x51435d53, | ||
82 | 0x251d3b9e, 0x21dc2629, 0x2c9f00f0, 0x285e1d47, 0x36194d42, 0x32d850f5, 0x3f9b762c, 0x3b5a6b9b, | ||
83 | 0x315d626, 0x7d4cb91, 0xa97ed48, 0xe56f0ff, 0x1011a0fa, 0x14d0bd4d, 0x19939b94, 0x1d528623, | ||
84 | 0xf12f560e, 0xf5ee4bb9, 0xf8ad6d60, 0xfc6c70d7, 0xe22b20d2, 0xe6ea3d65, 0xeba91bbc, 0xef68060b, | ||
85 | 0xd727bbb6, 0xd3e6a601, 0xdea580d8, 0xda649d6f, 0xc423cd6a, 0xc0e2d0dd, 0xcda1f604, 0xc960ebb3, | ||
86 | 0xbd3e8d7e, 0xb9ff90c9, 0xb4bcb610, 0xb07daba7, 0xae3afba2, 0xaafbe615, 0xa7b8c0cc, 0xa379dd7b, | ||
87 | 0x9b3660c6, 0x9ff77d71, 0x92b45ba8, 0x9675461f, 0x8832161a, 0x8cf30bad, 0x81b02d74, 0x857130c3, | ||
88 | 0x5d8a9099, 0x594b8d2e, 0x5408abf7, 0x50c9b640, 0x4e8ee645, 0x4a4ffbf2, 0x470cdd2b, 0x43cdc09c, | ||
89 | 0x7b827d21, 0x7f436096, 0x7200464f, 0x76c15bf8, 0x68860bfd, 0x6c47164a, 0x61043093, 0x65c52d24, | ||
90 | 0x119b4be9, 0x155a565e, 0x18197087, 0x1cd86d30, 0x29f3d35, 0x65e2082, 0xb1d065b, 0xfdc1bec, | ||
91 | 0x3793a651, 0x3352bbe6, 0x3e119d3f, 0x3ad08088, 0x2497d08d, 0x2056cd3a, 0x2d15ebe3, 0x29d4f654, | ||
92 | 0xc5a92679, 0xc1683bce, 0xcc2b1d17, 0xc8ea00a0, 0xd6ad50a5, 0xd26c4d12, 0xdf2f6bcb, 0xdbee767c, | ||
93 | 0xe3a1cbc1, 0xe760d676, 0xea23f0af, 0xeee2ed18, 0xf0a5bd1d, 0xf464a0aa, 0xf9278673, 0xfde69bc4, | ||
94 | 0x89b8fd09, 0x8d79e0be, 0x803ac667, 0x84fbdbd0, 0x9abc8bd5, 0x9e7d9662, 0x933eb0bb, 0x97ffad0c, | ||
95 | 0xafb010b1, 0xab710d06, 0xa6322bdf, 0xa2f33668, 0xbcb4666d, 0xb8757bda, 0xb5365d03, 0xb1f740b4}; | ||
96 | |||
97 | static uint32_t | ||
98 | 3771 | reflect (uint32_t data, uint8_t n_bits) | |
99 | { | ||
100 | 3771 | unsigned long reflection = 0x00000000; | |
101 | 3771 | uint8_t bit; | |
102 | |||
103 | /* | ||
104 | * Reflect the data about the center bit. | ||
105 | */ | ||
106 |
4/4✓ Branch 0 taken 5312 times.
✓ Branch 1 taken 166 times.
✓ Branch 2 taken 28840 times.
✓ Branch 3 taken 3605 times.
|
37923 | for (bit = 0; bit < n_bits; ++bit) |
107 | { | ||
108 | /* | ||
109 | * If the LSB bit is set, set the reflection of it. | ||
110 | */ | ||
111 |
4/4✓ Branch 0 taken 2668 times.
✓ Branch 1 taken 2644 times.
✓ Branch 2 taken 5590 times.
✓ Branch 3 taken 23250 times.
|
34152 | if (data & 0x01) |
112 | 8258 | reflection |= (1LU << ((n_bits - 1) - bit)); | |
113 | |||
114 | 34152 | data = (data >> 1); | |
115 | } | ||
116 | |||
117 | 3771 | return reflection; | |
118 | |||
119 | } | ||
120 | |||
121 | static void | ||
122 | 166 | crc32_init (gf_crc32_context *ctx) | |
123 | { | ||
124 | 166 | ctx->crc = 0xFFFFFFFF; | |
125 | } | ||
126 | |||
127 | static void | ||
128 | 166 | crc32_update (gf_crc32_context *ctx, const uint8_t *message, uint32_t n_bytes) | |
129 | { | ||
130 | 166 | uint8_t data; | |
131 | 166 | uint32_t byte; | |
132 | |||
133 | /* | ||
134 | * Divide the message by the polynomial, a byte at a time. | ||
135 | */ | ||
136 |
2/2✓ Branch 0 taken 3605 times.
✓ Branch 1 taken 166 times.
|
3771 | for (byte = 0; byte < n_bytes; ++byte) |
137 | { | ||
138 | 3605 | data = REFLECT_DATA (message[byte]) ^ (ctx->crc >> (WIDTH - 8)); | |
139 | 3605 | ctx->crc = s_crc_table[data] ^ (ctx->crc << 8); | |
140 | } | ||
141 | 166 | } | |
142 | |||
143 | static void | ||
144 | 166 | crc32_final (gf_crc32_context *ctx, uint8_t *md) | |
145 | { | ||
146 | 166 | uint32_t crc = 0; | |
147 | |||
148 | 166 | ctx->crc = (REFLECT_REMAINDER (ctx->crc) ^ FINAL_XOR_VALUE); | |
149 | 166 | crc = GUINT32_TO_LE (ctx->crc); | |
150 | 166 | memcpy (md, &crc, 4); | |
151 | 166 | } | |
152 | |||
153 | uint8_t | ||
154 | 166 | gx_proto_crc32_calc (uint8_t *pchMsg, uint32_t wDataLen, uint8_t *pchMsgDst) | |
155 | { | ||
156 | 166 | gf_crc32_context context = { 0 }; | |
157 | |||
158 |
1/2✓ Branch 0 taken 166 times.
✗ Branch 1 not taken.
|
166 | if (!pchMsg) |
159 | return 0; | ||
160 | |||
161 | 166 | crc32_init (&context); | |
162 | |||
163 | 166 | crc32_update (&context, pchMsg, wDataLen); | |
164 | |||
165 | 166 | crc32_final (&context, pchMsgDst); | |
166 | |||
167 | |||
168 | 166 | return 1; | |
169 | } | ||
170 | /* | ||
171 | * protocol | ||
172 | * | ||
173 | */ | ||
174 | |||
175 | static uint8_t dump_seq = 0; | ||
176 | |||
177 | static void | ||
178 | 55 | init_pack_header ( | |
179 | ppack_header pheader, | ||
180 | uint16_t len, | ||
181 | uint16_t cmd, | ||
182 | uint8_t packagenum | ||
183 | ) | ||
184 | { | ||
185 |
1/2✓ Branch 0 taken 55 times.
✗ Branch 1 not taken.
|
55 | g_assert (pheader); |
186 | |||
187 | 55 | memset (pheader, 0, sizeof (*pheader)); | |
188 | 55 | pheader->cmd0 = HIBYTE (cmd); | |
189 | 55 | pheader->cmd1 = LOBYTE (cmd); | |
190 | 55 | pheader->packagenum = packagenum; | |
191 | 55 | pheader->reserved = dump_seq++; | |
192 | 55 | pheader->len = GUINT16_TO_LE (len + PACKAGE_CRC_SIZE); | |
193 | 55 | pheader->crc8 = gx_proto_crc8_calc ((uint8_t *) pheader, 6); | |
194 | 55 | pheader->rev_crc8 = ~pheader->crc8; | |
195 | 55 | } | |
196 | |||
197 | |||
198 | int | ||
199 | 55 | gx_proto_build_package (uint8_t *ppackage, | |
200 | uint32_t *package_len, | ||
201 | uint16_t cmd, | ||
202 | const uint8_t *payload, | ||
203 | uint32_t payload_size) | ||
204 | { | ||
205 | 55 | pack_header header; | |
206 | |||
207 |
1/2✓ Branch 0 taken 55 times.
✗ Branch 1 not taken.
|
55 | if (!ppackage || !package_len) |
208 | return -1; | ||
209 | |||
210 |
1/2✓ Branch 0 taken 55 times.
✗ Branch 1 not taken.
|
55 | if(*package_len < (payload_size + PACKAGE_HEADER_SIZE + PACKAGE_CRC_SIZE)) |
211 | return -1; | ||
212 | |||
213 | 55 | init_pack_header (&header, payload_size, cmd, 0); | |
214 | |||
215 | 55 | memcpy (ppackage, &header, PACKAGE_HEADER_SIZE); | |
216 | |||
217 |
2/2✓ Branch 0 taken 48 times.
✓ Branch 1 taken 7 times.
|
55 | if (payload) |
218 | 48 | memcpy (ppackage + PACKAGE_HEADER_SIZE, payload, payload_size); | |
219 | else | ||
220 | 7 | ppackage[PACKAGE_HEADER_SIZE] = 0; | |
221 | |||
222 | 55 | gx_proto_crc32_calc (ppackage, PACKAGE_HEADER_SIZE + payload_size, ppackage + PACKAGE_HEADER_SIZE + payload_size); | |
223 | |||
224 | 55 | return 0; | |
225 | } | ||
226 | |||
227 | |||
228 | int | ||
229 | 110 | gx_proto_parse_header (FpiByteReader *reader, | |
230 | pack_header *pheader) | ||
231 | { | ||
232 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 110 times.
|
110 | if (!pheader) |
233 | return -1; | ||
234 | |||
235 |
1/2✓ Branch 0 taken 110 times.
✗ Branch 1 not taken.
|
110 | if (!fpi_byte_reader_get_uint8 (reader, &pheader->cmd0)) |
236 | ✗ | g_return_val_if_reached (-1); | |
237 | |||
238 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 110 times.
|
110 | if (!fpi_byte_reader_get_uint8 (reader, &pheader->cmd1)) |
239 | ✗ | g_return_val_if_reached (-1); | |
240 | |||
241 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 110 times.
|
110 | if (!fpi_byte_reader_get_uint8 (reader, &pheader->packagenum)) |
242 | ✗ | g_return_val_if_reached (-1); | |
243 | |||
244 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 110 times.
|
110 | if (!fpi_byte_reader_get_uint8 (reader, &pheader->reserved)) |
245 | ✗ | g_return_val_if_reached (-1); | |
246 | |||
247 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 110 times.
|
110 | if (!fpi_byte_reader_get_uint16_le (reader, &pheader->len)) |
248 | ✗ | g_return_val_if_reached (-1); | |
249 | |||
250 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 110 times.
|
110 | if (!fpi_byte_reader_get_uint8 (reader, &pheader->crc8)) |
251 | ✗ | g_return_val_if_reached (-1); | |
252 | |||
253 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 110 times.
|
110 | if (!fpi_byte_reader_get_uint8 (reader, &pheader->rev_crc8)) |
254 | ✗ | g_return_val_if_reached (-1); | |
255 | |||
256 | 110 | pheader->len -= PACKAGE_CRC_SIZE; | |
257 | |||
258 | 110 | return 0; | |
259 | } | ||
260 | |||
261 | static int | ||
262 | 3 | gx_proto_parse_fingerid (FpiByteReader *reader, | |
263 | ptemplate_format_t template) | ||
264 | { | ||
265 | 3 | uint8_t byte; | |
266 | 3 | const uint8_t *buffer; | |
267 | |||
268 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!template) |
269 | return -1; | ||
270 | |||
271 |
2/4✓ Branch 0 taken 3 times.
✗ Branch 1 not taken.
✗ Branch 2 not taken.
✓ Branch 3 taken 3 times.
|
3 | if (!fpi_byte_reader_get_uint8 (reader, &byte) || byte != 67) |
272 | ✗ | g_return_val_if_reached (-1); | |
273 | |||
274 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!fpi_byte_reader_get_uint8 (reader, &template->type)) |
275 | ✗ | g_return_val_if_reached (-1); | |
276 | |||
277 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!fpi_byte_reader_get_uint8 (reader, &template->finger_index)) |
278 | ✗ | g_return_val_if_reached (-1); | |
279 | |||
280 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!fpi_byte_reader_skip (reader, 1)) |
281 | ✗ | g_return_val_if_reached (-1); | |
282 | |||
283 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!fpi_byte_reader_get_data (reader, sizeof (template->accountid), &buffer)) |
284 | ✗ | g_return_val_if_reached (-1); | |
285 | |||
286 | 3 | memcpy (template->accountid, buffer, sizeof (template->accountid)); | |
287 | |||
288 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!fpi_byte_reader_get_data (reader, sizeof (template->tid), &buffer)) |
289 | ✗ | g_return_val_if_reached (-1); | |
290 | |||
291 | 3 | memcpy (template->tid, buffer, sizeof (template->tid)); | |
292 | |||
293 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!fpi_byte_reader_get_uint8 (reader, &template->payload.size)) |
294 | ✗ | g_return_val_if_reached (-1); | |
295 | |||
296 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!fpi_byte_reader_get_data (reader, template->payload.size, &buffer)) |
297 | ✗ | g_return_val_if_reached (-1); | |
298 | |||
299 | 3 | memcpy (template->payload.data, buffer, template->payload.size); | |
300 | |||
301 | 3 | return 0; | |
302 | } | ||
303 | |||
304 | int | ||
305 | 110 | gx_proto_parse_body (uint16_t cmd, FpiByteReader *byte_reader, pgxfp_cmd_response_t presp) | |
306 | { | ||
307 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 110 times.
|
110 | if (!presp) |
308 | return -1; | ||
309 | |||
310 |
1/2✓ Branch 0 taken 110 times.
✗ Branch 1 not taken.
|
110 | if (!fpi_byte_reader_get_uint8 (byte_reader, &presp->result)) |
311 | ✗ | g_return_val_if_reached (-1); | |
312 | |||
313 |
12/12✓ Branch 0 taken 55 times.
✓ Branch 1 taken 1 times.
✓ Branch 2 taken 6 times.
✓ Branch 3 taken 1 times.
✓ Branch 4 taken 14 times.
✓ Branch 5 taken 1 times.
✓ Branch 6 taken 12 times.
✓ Branch 7 taken 1 times.
✓ Branch 8 taken 3 times.
✓ Branch 9 taken 2 times.
✓ Branch 10 taken 11 times.
✓ Branch 11 taken 3 times.
|
110 | switch (HIBYTE (cmd)) |
314 | { | ||
315 | 55 | case RESPONSE_PACKAGE_CMD: | |
316 | { | ||
317 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 55 times.
|
55 | if (!fpi_byte_reader_get_uint8 (byte_reader, &presp->parse_msg.ack_cmd)) |
318 | ✗ | g_return_val_if_reached (-1); | |
319 | } | ||
320 | 110 | break; | |
321 | |||
322 | 1 | case MOC_CMD0_UPDATE_CONFIG: | |
323 | { | ||
324 | 1 | presp->finger_config.status = presp->result; | |
325 | /* to compatiable old version firmware */ | ||
326 | 1 | presp->finger_config.max_stored_prints = FP_MAX_FINGERNUM; | |
327 | |||
328 |
1/2✓ Branch 0 taken 1 times.
✗ Branch 1 not taken.
|
1 | if (fpi_byte_reader_skip (byte_reader, 1)) |
329 | 1 | fpi_byte_reader_get_uint8 (byte_reader, | |
330 | &presp->finger_config.max_stored_prints); | ||
331 | } | ||
332 | break; | ||
333 | |||
334 | case MOC_CMD0_COMMITENROLLMENT: | ||
335 | case MOC_CMD0_DELETETEMPLATE: | ||
336 | /* just check result */ | ||
337 | break; | ||
338 | |||
339 | 6 | case MOC_CMD0_PWR_BTN_SHIELD: | |
340 | 6 | presp->power_button_shield_resp.resp_cmd1 = LOBYTE (cmd); | |
341 | 6 | uint8_t support_pwr_shield; | |
342 | |||
343 |
1/2✓ Branch 0 taken 6 times.
✗ Branch 1 not taken.
|
6 | if (fpi_byte_reader_get_uint8 (byte_reader, &support_pwr_shield) && |
344 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 6 times.
|
6 | support_pwr_shield == 0xFF) |
345 | ✗ | g_debug ("Power button shield feature not supported!\n"); | |
346 | break; | ||
347 | |||
348 | 1 | case MOC_CMD0_GET_VERSION: | |
349 | 1 | const uint8_t *version_info; | |
350 | |||
351 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 1 times.
|
1 | if (!fpi_byte_reader_get_data (byte_reader, sizeof (gxfp_version_info_t), &version_info)) |
352 | ✗ | g_return_val_if_reached (-1); | |
353 | |||
354 | 1 | memcpy (&presp->version_info, version_info, sizeof (gxfp_version_info_t)); | |
355 | 1 | break; | |
356 | |||
357 | 14 | case MOC_CMD0_CAPTURE_DATA: | |
358 |
1/2✓ Branch 0 taken 14 times.
✗ Branch 1 not taken.
|
14 | if (LOBYTE (cmd) == MOC_CMD1_DEFAULT) |
359 | { | ||
360 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 14 times.
|
14 | if (!fpi_byte_reader_get_uint8 (byte_reader, |
361 | &presp->capture_data_resp.img_quality)) | ||
362 | ✗ | g_return_val_if_reached (-1); | |
363 | |||
364 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 14 times.
|
14 | if (!fpi_byte_reader_get_uint8 (byte_reader, |
365 | &presp->capture_data_resp.img_coverage)) | ||
366 | ✗ | g_return_val_if_reached (-1); | |
367 | } | ||
368 | break; | ||
369 | |||
370 | 1 | case MOC_CMD0_ENROLL_INIT: | |
371 |
1/2✓ Branch 0 taken 1 times.
✗ Branch 1 not taken.
|
1 | if (presp->result != GX_SUCCESS) |
372 | break; | ||
373 | 1 | const uint8_t *tid; | |
374 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 1 times.
|
1 | if (!fpi_byte_reader_get_data (byte_reader, TEMPLATE_ID_SIZE, &tid)) |
375 | ✗ | g_return_val_if_reached (-1); | |
376 | 1 | memcpy (presp->enroll_create.tid, tid, TEMPLATE_ID_SIZE); | |
377 | 1 | break; | |
378 | |||
379 | 12 | case MOC_CMD0_ENROLL: | |
380 | 12 | presp->enroll_update.rollback = (presp->result < 0x80) ? false : true; | |
381 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 12 times.
|
12 | if (!fpi_byte_reader_get_uint8 (byte_reader, |
382 | &presp->enroll_update.img_overlay)) | ||
383 | ✗ | g_return_val_if_reached (-1); | |
384 | |||
385 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 12 times.
|
12 | if (!fpi_byte_reader_get_uint8 (byte_reader, |
386 | &presp->enroll_update.img_preoverlay)) | ||
387 | ✗ | g_return_val_if_reached (-1); | |
388 | break; | ||
389 | |||
390 | 1 | case MOC_CMD0_CHECK4DUPLICATE: | |
391 | 1 | presp->check_duplicate_resp.duplicate = (presp->result == 0) ? false : true; | |
392 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 1 times.
|
1 | if (presp->check_duplicate_resp.duplicate) |
393 | { | ||
394 | ✗ | uint16_t tid_size; | |
395 | ✗ | FpiByteReader tid_reader; | |
396 | |||
397 | ✗ | if (!fpi_byte_reader_get_uint16_le (byte_reader, &tid_size)) | |
398 | ✗ | g_return_val_if_reached (-1); | |
399 | |||
400 | ✗ | if (!fpi_byte_reader_get_sub_reader (byte_reader, &tid_reader, tid_size)) | |
401 | ✗ | g_return_val_if_reached (-1); | |
402 | |||
403 | ✗ | if (gx_proto_parse_fingerid (&tid_reader, &presp->check_duplicate_resp.template) != 0) | |
404 | ✗ | g_return_val_if_reached (-1); | |
405 | } | ||
406 | break; | ||
407 | |||
408 | 3 | case MOC_CMD0_GETFINGERLIST: | |
409 |
1/2✓ Branch 0 taken 3 times.
✗ Branch 1 not taken.
|
3 | if (presp->result != GX_SUCCESS) |
410 | break; | ||
411 | |||
412 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 3 times.
|
3 | if (!fpi_byte_reader_get_uint8 (byte_reader, |
413 | &presp->finger_list_resp.finger_num)) | ||
414 | ✗ | g_return_val_if_reached (-1); | |
415 | |||
416 |
2/2✓ Branch 0 taken 1 times.
✓ Branch 1 taken 3 times.
|
4 | for(uint8_t num = 0; num < presp->finger_list_resp.finger_num; num++) |
417 | { | ||
418 | 1 | uint16_t fingerid_length; | |
419 | 1 | FpiByteReader fingerid_reader; | |
420 | |||
421 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 1 times.
|
1 | if (!fpi_byte_reader_get_uint16_le (byte_reader, &fingerid_length)) |
422 | ✗ | g_return_val_if_reached (-1); | |
423 | |||
424 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 1 times.
|
1 | if (!fpi_byte_reader_get_sub_reader (byte_reader, &fingerid_reader, |
425 | fingerid_length)) | ||
426 | ✗ | g_return_val_if_reached (-1); | |
427 | |||
428 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 1 times.
|
1 | if (gx_proto_parse_fingerid (&fingerid_reader, |
429 | 1 | &presp->finger_list_resp.finger_list[num]) != 0) | |
430 | { | ||
431 | ✗ | g_warning ("Failed to parse finger list"); | |
432 | 1 | g_return_val_if_reached (-1); | |
433 | } | ||
434 | } | ||
435 | break; | ||
436 | |||
437 | 2 | case MOC_CMD0_IDENTIFY: | |
438 | { | ||
439 | 2 | uint32_t score = 0; | |
440 | 2 | uint8_t study = 0; | |
441 | 2 | uint16_t fingerid_size = 0; | |
442 | |||
443 | 2 | presp->verify.match = (presp->result == 0) ? true : false; | |
444 | |||
445 |
1/2✓ Branch 0 taken 2 times.
✗ Branch 1 not taken.
|
2 | if (presp->verify.match) |
446 | { | ||
447 | 2 | FpiByteReader finger_reader; | |
448 | |||
449 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 2 times.
|
2 | if (!fpi_byte_reader_get_uint16_le (byte_reader, |
450 | &presp->verify.rejectdetail)) | ||
451 | ✗ | g_return_val_if_reached (-1); | |
452 | |||
453 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 2 times.
|
2 | if (!fpi_byte_reader_get_uint32_le (byte_reader, &score)) |
454 | ✗ | g_return_val_if_reached (-1); | |
455 | |||
456 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 2 times.
|
2 | if (!fpi_byte_reader_get_uint8 (byte_reader, &study)) |
457 | ✗ | g_return_val_if_reached (-1); | |
458 | |||
459 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 2 times.
|
2 | if (!fpi_byte_reader_get_uint16_le (byte_reader, &fingerid_size)) |
460 | ✗ | g_return_val_if_reached (-1); | |
461 | |||
462 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 2 times.
|
2 | if (!fpi_byte_reader_get_sub_reader (byte_reader, &finger_reader, |
463 | fingerid_size)) | ||
464 | ✗ | g_return_val_if_reached (-1); | |
465 | |||
466 |
1/2✗ Branch 0 not taken.
✓ Branch 1 taken 2 times.
|
2 | if (gx_proto_parse_fingerid (&finger_reader, |
467 | 2 | &presp->verify.template) != 0) | |
468 | { | ||
469 | ✗ | presp->result = GX_FAILED; | |
470 | ✗ | break; | |
471 | } | ||
472 | 2 | g_debug ("match, score: %d, study: %d", score, study); | |
473 | } | ||
474 | } | ||
475 | 2 | break; | |
476 | |||
477 | 11 | case MOC_CMD0_FINGER_MODE: | |
478 | 11 | presp->finger_status.status = presp->result; | |
479 | 11 | break; | |
480 | |||
481 | default: | ||
482 | break; | ||
483 | } | ||
484 | |||
485 | 110 | return 0; | |
486 | } | ||
487 | |||
488 | static uint8_t sensor_config[26] = { | ||
489 | 0x00, 0x00, 0x64, 0x50, 0x0f, 0x41, 0x08, 0x0a, 0x18, 0x00, 0x00, 0x23, 0x00, | ||
490 | 0x00, 0x01, 0x01, 0x00, 0x01, 0x01, 0x01, 0x01, 0x00, 0x01, 0x01, 0x05, 0x05 | ||
491 | }; | ||
492 | |||
493 | int | ||
494 | 1 | gx_proto_init_sensor_config (pgxfp_sensor_cfg_t pconfig) | |
495 | { | ||
496 | 1 | uint32_t crc32_calc = 0; | |
497 | |||
498 |
1/2✓ Branch 0 taken 1 times.
✗ Branch 1 not taken.
|
1 | if (!pconfig) |
499 | return -1; | ||
500 | 1 | memset (pconfig, 0, sizeof (*pconfig)); | |
501 | |||
502 | //NOTICE: Do not change any value! | ||
503 | 1 | memcpy (&pconfig->config, sensor_config, G_N_ELEMENTS (sensor_config)); | |
504 | 1 | pconfig->reserved[0] = 1; | |
505 | |||
506 | 1 | gx_proto_crc32_calc ((uint8_t *) pconfig, sizeof (*pconfig) - PACKAGE_CRC_SIZE, (uint8_t *) &crc32_calc); | |
507 | |||
508 | 1 | memcpy (pconfig->crc_value, &crc32_calc, PACKAGE_CRC_SIZE); | |
509 | |||
510 | 1 | return 0; | |
511 | } | ||
512 |