1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause 2 /* 3 * CCS static data binary parser library 4 * 5 * Copyright 2019--2020 Intel Corporation 6 */ 7 8 #include <linux/device.h> 9 #include <linux/errno.h> 10 #include <linux/limits.h> 11 #include <linux/mm.h> 12 #include <linux/slab.h> 13 14 #include "ccs-data-defs.h" 15 16 struct bin_container { 17 void *base; 18 void *now; 19 void *end; 20 size_t size; 21 }; 22 bin_alloc(struct bin_container * bin,size_t len)23 static void *bin_alloc(struct bin_container *bin, size_t len) 24 { 25 void *ptr; 26 27 len = ALIGN(len, 8); 28 29 if (bin->end - bin->now < len) 30 return NULL; 31 32 ptr = bin->now; 33 bin->now += len; 34 35 return ptr; 36 } 37 bin_reserve(struct bin_container * bin,size_t len)38 static void bin_reserve(struct bin_container *bin, size_t len) 39 { 40 bin->size += ALIGN(len, 8); 41 } 42 bin_backing_alloc(struct bin_container * bin)43 static int bin_backing_alloc(struct bin_container *bin) 44 { 45 bin->base = bin->now = kvzalloc(bin->size, GFP_KERNEL); 46 if (!bin->base) 47 return -ENOMEM; 48 49 bin->end = bin->base + bin->size; 50 51 return 0; 52 } 53 54 #define is_contained(var, endp) \ 55 (sizeof(*var) <= (endp) - (void *)(var)) 56 #define has_headroom(ptr, headroom, endp) \ 57 ((headroom) <= (endp) - (void *)(ptr)) 58 #define is_contained_with_headroom(var, headroom, endp) \ 59 (sizeof(*var) + (headroom) <= (endp) - (void *)(var)) 60 61 static int ccs_data_parse_length_specifier(const struct __ccs_data_length_specifier * __len,size_t * __hlen,size_t * __plen,const void * endp)62 ccs_data_parse_length_specifier(const struct __ccs_data_length_specifier *__len, 63 size_t *__hlen, size_t *__plen, 64 const void *endp) 65 { 66 size_t hlen, plen; 67 68 if (!is_contained(__len, endp)) 69 return -ENODATA; 70 71 switch (__len->length >> CCS_DATA_LENGTH_SPECIFIER_SIZE_SHIFT) { 72 case CCS_DATA_LENGTH_SPECIFIER_1: 73 hlen = sizeof(*__len); 74 plen = __len->length & 75 ((1 << CCS_DATA_LENGTH_SPECIFIER_SIZE_SHIFT) - 1); 76 break; 77 case CCS_DATA_LENGTH_SPECIFIER_2: { 78 struct __ccs_data_length_specifier2 *__len2 = (void *)__len; 79 80 if (!is_contained(__len2, endp)) 81 return -ENODATA; 82 83 hlen = sizeof(*__len2); 84 plen = ((size_t) 85 (__len2->length[0] & 86 ((1 << CCS_DATA_LENGTH_SPECIFIER_SIZE_SHIFT) - 1)) 87 << 8) + __len2->length[1]; 88 break; 89 } 90 case CCS_DATA_LENGTH_SPECIFIER_3: { 91 struct __ccs_data_length_specifier3 *__len3 = (void *)__len; 92 93 if (!is_contained(__len3, endp)) 94 return -ENODATA; 95 96 hlen = sizeof(*__len3); 97 plen = ((size_t) 98 (__len3->length[0] & 99 ((1 << CCS_DATA_LENGTH_SPECIFIER_SIZE_SHIFT) - 1)) 100 << 16) + (__len3->length[0] << 8) + __len3->length[1]; 101 break; 102 } 103 default: 104 return -EINVAL; 105 } 106 107 if (!has_headroom(__len, hlen + plen, endp)) 108 return -ENODATA; 109 110 *__hlen = hlen; 111 *__plen = plen; 112 113 return 0; 114 } 115 116 static u8 ccs_data_parse_format_version(const struct __ccs_data_block * block)117 ccs_data_parse_format_version(const struct __ccs_data_block *block) 118 { 119 return block->id >> CCS_DATA_BLOCK_HEADER_ID_VERSION_SHIFT; 120 } 121 ccs_data_parse_block_id(const struct __ccs_data_block * block,bool is_first)122 static u8 ccs_data_parse_block_id(const struct __ccs_data_block *block, 123 bool is_first) 124 { 125 if (!is_first) 126 return block->id; 127 128 return block->id & ((1 << CCS_DATA_BLOCK_HEADER_ID_VERSION_SHIFT) - 1); 129 } 130 ccs_data_parse_version(struct bin_container * bin,struct ccs_data_container * ccsdata,const void * payload,const void * endp)131 static int ccs_data_parse_version(struct bin_container *bin, 132 struct ccs_data_container *ccsdata, 133 const void *payload, const void *endp) 134 { 135 const struct __ccs_data_block_version *v = payload; 136 struct ccs_data_block_version *vv; 137 138 if (v + 1 != endp) 139 return -ENODATA; 140 141 if (!bin->base) { 142 bin_reserve(bin, sizeof(*ccsdata->version)); 143 return 0; 144 } 145 146 ccsdata->version = bin_alloc(bin, sizeof(*ccsdata->version)); 147 if (!ccsdata->version) 148 return -ENOMEM; 149 150 vv = ccsdata->version; 151 vv->version_major = ((u16)v->static_data_version_major[0] << 8) + 152 v->static_data_version_major[1]; 153 vv->version_minor = ((u16)v->static_data_version_minor[0] << 8) + 154 v->static_data_version_minor[1]; 155 vv->date_year = ((u16)v->year[0] << 8) + v->year[1]; 156 vv->date_month = v->month; 157 vv->date_day = v->day; 158 159 return 0; 160 } 161 print_ccs_data_version(struct device * dev,struct ccs_data_block_version * v)162 static void print_ccs_data_version(struct device *dev, 163 struct ccs_data_block_version *v) 164 { 165 dev_dbg(dev, 166 "static data version %4.4x.%4.4x, date %4.4u-%2.2u-%2.2u\n", 167 v->version_major, v->version_minor, 168 v->date_year, v->date_month, v->date_day); 169 } 170 ccs_data_block_parse_header(const struct __ccs_data_block * block,bool is_first,unsigned int * __block_id,const void ** payload,const struct __ccs_data_block ** next_block,const void * endp,struct device * dev,bool verbose)171 static int ccs_data_block_parse_header(const struct __ccs_data_block *block, 172 bool is_first, unsigned int *__block_id, 173 const void **payload, 174 const struct __ccs_data_block **next_block, 175 const void *endp, struct device *dev, 176 bool verbose) 177 { 178 size_t plen, hlen; 179 u8 block_id; 180 int rval; 181 182 if (!is_contained(block, endp)) 183 return -ENODATA; 184 185 rval = ccs_data_parse_length_specifier(&block->length, &hlen, &plen, 186 endp); 187 if (rval < 0) 188 return rval; 189 190 block_id = ccs_data_parse_block_id(block, is_first); 191 192 if (verbose) 193 dev_dbg(dev, 194 "Block ID 0x%2.2x, header length %zu, payload length %zu\n", 195 block_id, hlen, plen); 196 197 if (!has_headroom(&block->length, hlen + plen, endp)) 198 return -ENODATA; 199 200 if (__block_id) 201 *__block_id = block_id; 202 203 if (payload) 204 *payload = (void *)&block->length + hlen; 205 206 if (next_block) 207 *next_block = (void *)&block->length + hlen + plen; 208 209 return 0; 210 } 211 ccs_data_parse_regs(struct bin_container * bin,struct ccs_reg ** __regs,size_t * __num_regs,const void * payload,const void * endp,struct device * dev)212 static int ccs_data_parse_regs(struct bin_container *bin, 213 struct ccs_reg **__regs, 214 size_t *__num_regs, const void *payload, 215 const void *endp, struct device *dev) 216 { 217 struct ccs_reg *regs_base = NULL, *regs = NULL; 218 size_t num_regs = 0; 219 u16 addr = 0; 220 221 if (bin->base && __regs) { 222 regs = regs_base = bin_alloc(bin, sizeof(*regs) * *__num_regs); 223 if (!regs) 224 return -ENOMEM; 225 } 226 227 while (payload < endp && num_regs < INT_MAX) { 228 const struct __ccs_data_block_regs *r = payload; 229 size_t len; 230 const void *data; 231 232 if (!is_contained(r, endp)) 233 return -ENODATA; 234 235 switch (r->reg_len >> CCS_DATA_BLOCK_REGS_SEL_SHIFT) { 236 case CCS_DATA_BLOCK_REGS_SEL_REGS: 237 addr += r->reg_len & CCS_DATA_BLOCK_REGS_ADDR_MASK; 238 len = ((r->reg_len & CCS_DATA_BLOCK_REGS_LEN_MASK) 239 >> CCS_DATA_BLOCK_REGS_LEN_SHIFT) + 1; 240 241 if (!is_contained_with_headroom(r, len, endp)) 242 return -ENODATA; 243 244 data = r + 1; 245 break; 246 case CCS_DATA_BLOCK_REGS_SEL_REGS2: { 247 const struct __ccs_data_block_regs2 *r2 = payload; 248 249 if (!is_contained(r2, endp)) 250 return -ENODATA; 251 252 addr += ((u16)(r2->reg_len & 253 CCS_DATA_BLOCK_REGS_2_ADDR_MASK) << 8) 254 + r2->addr; 255 len = ((r2->reg_len & CCS_DATA_BLOCK_REGS_2_LEN_MASK) 256 >> CCS_DATA_BLOCK_REGS_2_LEN_SHIFT) + 1; 257 258 if (!is_contained_with_headroom(r2, len, endp)) 259 return -ENODATA; 260 261 data = r2 + 1; 262 break; 263 } 264 case CCS_DATA_BLOCK_REGS_SEL_REGS3: { 265 const struct __ccs_data_block_regs3 *r3 = payload; 266 267 if (!is_contained(r3, endp)) 268 return -ENODATA; 269 270 addr = ((u16)r3->addr[0] << 8) + r3->addr[1]; 271 len = (r3->reg_len & CCS_DATA_BLOCK_REGS_3_LEN_MASK) + 1; 272 273 if (!is_contained_with_headroom(r3, len, endp)) 274 return -ENODATA; 275 276 data = r3 + 1; 277 break; 278 } 279 default: 280 return -EINVAL; 281 } 282 283 num_regs++; 284 285 if (!bin->base) { 286 bin_reserve(bin, len); 287 } else if (__regs) { 288 if (!regs) 289 return -EIO; 290 291 regs->addr = addr; 292 regs->len = len; 293 regs->value = bin_alloc(bin, len); 294 if (!regs->value) 295 return -ENOMEM; 296 297 memcpy(regs->value, data, len); 298 regs++; 299 } 300 301 addr += len; 302 payload = data + len; 303 } 304 305 if (!bin->base) 306 bin_reserve(bin, sizeof(*regs) * num_regs); 307 308 if (__num_regs) 309 *__num_regs = num_regs; 310 311 if (bin->base && __regs) { 312 if (!regs_base) 313 return -EIO; 314 315 *__regs = regs_base; 316 } 317 318 return 0; 319 } 320 ccs_data_parse_reg_rules(struct bin_container * bin,struct ccs_reg ** __regs,size_t * __num_regs,const void * payload,const void * endp,struct device * dev)321 static int ccs_data_parse_reg_rules(struct bin_container *bin, 322 struct ccs_reg **__regs, 323 size_t *__num_regs, 324 const void *payload, 325 const void *endp, struct device *dev) 326 { 327 int rval; 328 329 if (!bin->base) 330 return ccs_data_parse_regs(bin, NULL, NULL, payload, endp, dev); 331 332 rval = ccs_data_parse_regs(bin, NULL, __num_regs, payload, endp, dev); 333 if (rval) 334 return rval; 335 336 return ccs_data_parse_regs(bin, __regs, __num_regs, payload, endp, 337 dev); 338 } 339 assign_ffd_entry(struct ccs_frame_format_desc * desc,const struct __ccs_data_block_ffd_entry * ent)340 static void assign_ffd_entry(struct ccs_frame_format_desc *desc, 341 const struct __ccs_data_block_ffd_entry *ent) 342 { 343 desc->pixelcode = ent->pixelcode; 344 desc->value = ((u16)ent->value[0] << 8) + ent->value[1]; 345 } 346 ccs_data_parse_ffd(struct bin_container * bin,struct ccs_frame_format_descs ** ffd,const void * payload,const void * endp,struct device * dev)347 static int ccs_data_parse_ffd(struct bin_container *bin, 348 struct ccs_frame_format_descs **ffd, 349 const void *payload, 350 const void *endp, struct device *dev) 351 { 352 const struct __ccs_data_block_ffd *__ffd = payload; 353 const struct __ccs_data_block_ffd_entry *__entry; 354 unsigned int i; 355 356 if (!is_contained(__ffd, endp)) 357 return -ENODATA; 358 359 if ((void *)__ffd + sizeof(*__ffd) + 360 ((u32)__ffd->num_column_descs + 361 (u32)__ffd->num_row_descs) * 362 sizeof(struct __ccs_data_block_ffd_entry) != endp) 363 return -ENODATA; 364 365 if (!bin->base) { 366 bin_reserve(bin, sizeof(**ffd)); 367 bin_reserve(bin, __ffd->num_column_descs * 368 sizeof(struct ccs_frame_format_desc)); 369 bin_reserve(bin, __ffd->num_row_descs * 370 sizeof(struct ccs_frame_format_desc)); 371 372 return 0; 373 } 374 375 *ffd = bin_alloc(bin, sizeof(**ffd)); 376 if (!*ffd) 377 return -ENOMEM; 378 379 (*ffd)->num_column_descs = __ffd->num_column_descs; 380 (*ffd)->num_row_descs = __ffd->num_row_descs; 381 __entry = (void *)(__ffd + 1); 382 383 (*ffd)->column_descs = bin_alloc(bin, __ffd->num_column_descs * 384 sizeof(*(*ffd)->column_descs)); 385 if (!(*ffd)->column_descs) 386 return -ENOMEM; 387 388 for (i = 0; i < __ffd->num_column_descs; i++, __entry++) 389 assign_ffd_entry(&(*ffd)->column_descs[i], __entry); 390 391 (*ffd)->row_descs = bin_alloc(bin, __ffd->num_row_descs * 392 sizeof(*(*ffd)->row_descs)); 393 if (!(*ffd)->row_descs) 394 return -ENOMEM; 395 396 for (i = 0; i < __ffd->num_row_descs; i++, __entry++) 397 assign_ffd_entry(&(*ffd)->row_descs[i], __entry); 398 399 if (__entry != endp) 400 return -EPROTO; 401 402 return 0; 403 } 404 ccs_data_parse_pdaf_readout(struct bin_container * bin,struct ccs_pdaf_readout ** pdaf_readout,const void * payload,const void * endp,struct device * dev)405 static int ccs_data_parse_pdaf_readout(struct bin_container *bin, 406 struct ccs_pdaf_readout **pdaf_readout, 407 const void *payload, 408 const void *endp, struct device *dev) 409 { 410 const struct __ccs_data_block_pdaf_readout *__pdaf = payload; 411 412 if (!is_contained(__pdaf, endp)) 413 return -ENODATA; 414 415 if (!bin->base) { 416 bin_reserve(bin, sizeof(**pdaf_readout)); 417 } else { 418 *pdaf_readout = bin_alloc(bin, sizeof(**pdaf_readout)); 419 if (!*pdaf_readout) 420 return -ENOMEM; 421 422 (*pdaf_readout)->pdaf_readout_info_order = 423 __pdaf->pdaf_readout_info_order; 424 } 425 426 return ccs_data_parse_ffd(bin, !bin->base ? NULL : &(*pdaf_readout)->ffd, 427 __pdaf + 1, endp, dev); 428 } 429 ccs_data_parse_rules(struct bin_container * bin,struct ccs_rule ** __rules,size_t * __num_rules,const void * payload,const void * endp,struct device * dev)430 static int ccs_data_parse_rules(struct bin_container *bin, 431 struct ccs_rule **__rules, 432 size_t *__num_rules, const void *payload, 433 const void *endp, struct device *dev) 434 { 435 struct ccs_rule *rules_base = NULL, *rules = NULL, *next_rule = NULL; 436 size_t num_rules = 0; 437 const void *__next_rule = payload; 438 int rval; 439 440 if (bin->base) { 441 rules_base = next_rule = 442 bin_alloc(bin, sizeof(*rules) * *__num_rules); 443 if (!rules_base) 444 return -ENOMEM; 445 } 446 447 while (__next_rule < endp) { 448 size_t rule_hlen, rule_plen, rule_plen2; 449 const u8 *__rule_type; 450 const void *rule_payload; 451 452 /* Size of a single rule */ 453 rval = ccs_data_parse_length_specifier(__next_rule, &rule_hlen, 454 &rule_plen, endp); 455 456 if (rval < 0) 457 return rval; 458 459 __rule_type = __next_rule + rule_hlen; 460 461 if (!is_contained(__rule_type, endp)) 462 return -ENODATA; 463 464 rule_payload = __rule_type + 1; 465 rule_plen2 = rule_plen - sizeof(*__rule_type); 466 467 if (*__rule_type == CCS_DATA_BLOCK_RULE_ID_IF) { 468 const struct __ccs_data_block_rule_if *__if_rules = 469 rule_payload; 470 const size_t __num_if_rules = 471 rule_plen2 / sizeof(*__if_rules); 472 struct ccs_if_rule *if_rule; 473 474 if (!has_headroom(__if_rules, 475 sizeof(*__if_rules) * __num_if_rules, 476 rule_payload + rule_plen2)) 477 return -ENODATA; 478 479 /* Also check there is no extra data */ 480 if (__if_rules + __num_if_rules != 481 rule_payload + rule_plen2) 482 return -EINVAL; 483 484 if (!bin->base) { 485 bin_reserve(bin, 486 sizeof(*if_rule) * 487 __num_if_rules); 488 num_rules++; 489 } else { 490 unsigned int i; 491 492 if (!next_rule) 493 return -EIO; 494 495 rules = next_rule; 496 next_rule++; 497 498 if_rule = bin_alloc(bin, 499 sizeof(*if_rule) * 500 __num_if_rules); 501 if (!if_rule) 502 return -ENOMEM; 503 504 for (i = 0; i < __num_if_rules; i++) { 505 if_rule[i].addr = 506 ((u16)__if_rules[i].addr[0] 507 << 8) + 508 __if_rules[i].addr[1]; 509 if_rule[i].value = __if_rules[i].value; 510 if_rule[i].mask = __if_rules[i].mask; 511 } 512 513 rules->if_rules = if_rule; 514 rules->num_if_rules = __num_if_rules; 515 } 516 } else { 517 /* Check there was an if rule before any other rules */ 518 if (bin->base && !rules) 519 return -EINVAL; 520 521 switch (*__rule_type) { 522 case CCS_DATA_BLOCK_RULE_ID_READ_ONLY_REGS: 523 rval = ccs_data_parse_reg_rules(bin, 524 rules ? 525 &rules->read_only_regs : NULL, 526 rules ? 527 &rules->num_read_only_regs : NULL, 528 rule_payload, 529 rule_payload + rule_plen2, 530 dev); 531 if (rval) 532 return rval; 533 break; 534 case CCS_DATA_BLOCK_RULE_ID_FFD: 535 rval = ccs_data_parse_ffd(bin, rules ? 536 &rules->frame_format : NULL, 537 rule_payload, 538 rule_payload + rule_plen2, 539 dev); 540 if (rval) 541 return rval; 542 break; 543 case CCS_DATA_BLOCK_RULE_ID_MSR: 544 rval = ccs_data_parse_reg_rules(bin, 545 rules ? 546 &rules->manufacturer_regs : NULL, 547 rules ? 548 &rules->num_manufacturer_regs : NULL, 549 rule_payload, 550 rule_payload + rule_plen2, 551 dev); 552 if (rval) 553 return rval; 554 break; 555 case CCS_DATA_BLOCK_RULE_ID_PDAF_READOUT: 556 rval = ccs_data_parse_pdaf_readout(bin, 557 rules ? 558 &rules->pdaf_readout : NULL, 559 rule_payload, 560 rule_payload + rule_plen2, 561 dev); 562 if (rval) 563 return rval; 564 break; 565 default: 566 dev_dbg(dev, 567 "Don't know how to handle rule type %u!\n", 568 *__rule_type); 569 return -EINVAL; 570 } 571 } 572 __next_rule = __next_rule + rule_hlen + rule_plen; 573 } 574 575 if (!bin->base) { 576 bin_reserve(bin, sizeof(*rules) * num_rules); 577 *__num_rules = num_rules; 578 } else { 579 if (!rules_base) 580 return -EIO; 581 582 *__rules = rules_base; 583 } 584 585 return 0; 586 } 587 ccs_data_parse_pdaf(struct bin_container * bin,struct ccs_pdaf_pix_loc ** pdaf,const void * payload,const void * endp,struct device * dev)588 static int ccs_data_parse_pdaf(struct bin_container *bin, struct ccs_pdaf_pix_loc **pdaf, 589 const void *payload, const void *endp, 590 struct device *dev) 591 { 592 const struct __ccs_data_block_pdaf_pix_loc *__pdaf = payload; 593 const struct __ccs_data_block_pdaf_pix_loc_block_desc_group *__bdesc_group; 594 const struct __ccs_data_block_pdaf_pix_loc_pixel_desc *__pixel_desc; 595 unsigned int i; 596 u16 num_block_desc_groups; 597 u8 max_block_type_id = 0; 598 const u8 *__num_pixel_descs; 599 600 if (!is_contained(__pdaf, endp)) 601 return -ENODATA; 602 603 if (bin->base) { 604 *pdaf = bin_alloc(bin, sizeof(**pdaf)); 605 if (!*pdaf) 606 return -ENOMEM; 607 } else { 608 bin_reserve(bin, sizeof(**pdaf)); 609 } 610 611 num_block_desc_groups = 612 ((u16)__pdaf->num_block_desc_groups[0] << 8) + 613 __pdaf->num_block_desc_groups[1]; 614 615 if (bin->base) { 616 (*pdaf)->main_offset_x = 617 ((u16)__pdaf->main_offset_x[0] << 8) + 618 __pdaf->main_offset_x[1]; 619 (*pdaf)->main_offset_y = 620 ((u16)__pdaf->main_offset_y[0] << 8) + 621 __pdaf->main_offset_y[1]; 622 (*pdaf)->global_pdaf_type = __pdaf->global_pdaf_type; 623 (*pdaf)->block_width = __pdaf->block_width; 624 (*pdaf)->block_height = __pdaf->block_height; 625 (*pdaf)->num_block_desc_groups = num_block_desc_groups; 626 } 627 628 __bdesc_group = (const void *)(__pdaf + 1); 629 630 if (bin->base) { 631 (*pdaf)->block_desc_groups = 632 bin_alloc(bin, 633 sizeof(struct ccs_pdaf_pix_loc_block_desc_group) * 634 num_block_desc_groups); 635 if (!(*pdaf)->block_desc_groups) 636 return -ENOMEM; 637 } else { 638 bin_reserve(bin, sizeof(struct ccs_pdaf_pix_loc_block_desc_group) * 639 num_block_desc_groups); 640 } 641 642 for (i = 0; i < num_block_desc_groups; i++) { 643 const struct __ccs_data_block_pdaf_pix_loc_block_desc *__bdesc; 644 u16 num_block_descs; 645 unsigned int j; 646 647 if (!is_contained(__bdesc_group, endp)) 648 return -ENODATA; 649 650 num_block_descs = 651 ((u16)__bdesc_group->num_block_descs[0] << 8) + 652 __bdesc_group->num_block_descs[1]; 653 654 if (bin->base) { 655 (*pdaf)->block_desc_groups[i].repeat_y = 656 __bdesc_group->repeat_y; 657 (*pdaf)->block_desc_groups[i].num_block_descs = 658 num_block_descs; 659 } 660 661 __bdesc = (const void *)(__bdesc_group + 1); 662 663 if (bin->base) { 664 (*pdaf)->block_desc_groups[i].block_descs = 665 bin_alloc(bin, 666 sizeof(struct ccs_pdaf_pix_loc_block_desc) * 667 num_block_descs); 668 if (!(*pdaf)->block_desc_groups[i].block_descs) 669 return -ENOMEM; 670 } else { 671 bin_reserve(bin, sizeof(struct ccs_pdaf_pix_loc_block_desc) * 672 num_block_descs); 673 } 674 675 for (j = 0; j < num_block_descs; j++, __bdesc++) { 676 struct ccs_pdaf_pix_loc_block_desc *bdesc; 677 678 if (!is_contained(__bdesc, endp)) 679 return -ENODATA; 680 681 if (max_block_type_id <= __bdesc->block_type_id) 682 max_block_type_id = __bdesc->block_type_id + 1; 683 684 if (!bin->base) 685 continue; 686 687 bdesc = &(*pdaf)->block_desc_groups[i].block_descs[j]; 688 689 bdesc->repeat_x = ((u16)__bdesc->repeat_x[0] << 8) 690 + __bdesc->repeat_x[1]; 691 692 if (__bdesc->block_type_id >= num_block_descs) 693 return -EINVAL; 694 695 bdesc->block_type_id = __bdesc->block_type_id; 696 } 697 698 __bdesc_group = (const void *)__bdesc; 699 } 700 701 __num_pixel_descs = (const void *)__bdesc_group; 702 703 if (bin->base) { 704 (*pdaf)->pixel_desc_groups = 705 bin_alloc(bin, 706 sizeof(struct ccs_pdaf_pix_loc_pixel_desc_group) * 707 max_block_type_id); 708 if (!(*pdaf)->pixel_desc_groups) 709 return -ENOMEM; 710 (*pdaf)->num_pixel_desc_grups = max_block_type_id; 711 } else { 712 bin_reserve(bin, sizeof(struct ccs_pdaf_pix_loc_pixel_desc_group) * 713 max_block_type_id); 714 } 715 716 for (i = 0; i < max_block_type_id; i++) { 717 struct ccs_pdaf_pix_loc_pixel_desc_group *pdgroup = NULL; 718 unsigned int j; 719 720 if (!is_contained(__num_pixel_descs, endp)) 721 return -ENODATA; 722 723 if (bin->base) { 724 pdgroup = &(*pdaf)->pixel_desc_groups[i]; 725 pdgroup->descs = 726 bin_alloc(bin, 727 sizeof(struct ccs_pdaf_pix_loc_pixel_desc) * 728 *__num_pixel_descs); 729 if (!pdgroup->descs) 730 return -ENOMEM; 731 pdgroup->num_descs = *__num_pixel_descs; 732 } else { 733 bin_reserve(bin, sizeof(struct ccs_pdaf_pix_loc_pixel_desc) * 734 *__num_pixel_descs); 735 } 736 737 __pixel_desc = (const void *)(__num_pixel_descs + 1); 738 739 for (j = 0; j < *__num_pixel_descs; j++, __pixel_desc++) { 740 struct ccs_pdaf_pix_loc_pixel_desc *pdesc; 741 742 if (!is_contained(__pixel_desc, endp)) 743 return -ENODATA; 744 745 if (!bin->base) 746 continue; 747 748 if (!pdgroup) 749 return -EIO; 750 751 pdesc = &pdgroup->descs[j]; 752 pdesc->pixel_type = __pixel_desc->pixel_type; 753 pdesc->small_offset_x = __pixel_desc->small_offset_x; 754 pdesc->small_offset_y = __pixel_desc->small_offset_y; 755 } 756 757 __num_pixel_descs = (const void *)(__pixel_desc + 1); 758 } 759 760 return 0; 761 } 762 ccs_data_parse_license(struct bin_container * bin,char ** __license,size_t * __license_length,const void * payload,const void * endp)763 static int ccs_data_parse_license(struct bin_container *bin, 764 char **__license, 765 size_t *__license_length, 766 const void *payload, const void *endp) 767 { 768 size_t size = endp - payload; 769 char *license; 770 771 if (!bin->base) { 772 bin_reserve(bin, size); 773 return 0; 774 } 775 776 license = bin_alloc(bin, size); 777 if (!license) 778 return -ENOMEM; 779 780 memcpy(license, payload, size); 781 782 *__license = license; 783 *__license_length = size; 784 785 return 0; 786 } 787 ccs_data_parse_end(bool * end,const void * payload,const void * endp,struct device * dev)788 static int ccs_data_parse_end(bool *end, const void *payload, const void *endp, 789 struct device *dev) 790 { 791 const struct __ccs_data_block_end *__end = payload; 792 793 if (__end + 1 != endp) { 794 dev_dbg(dev, "Invalid end block length %u\n", 795 (unsigned int)(endp - payload)); 796 return -ENODATA; 797 } 798 799 *end = true; 800 801 return 0; 802 } 803 __ccs_data_parse(struct bin_container * bin,struct ccs_data_container * ccsdata,const void * data,size_t len,struct device * dev,bool verbose)804 static int __ccs_data_parse(struct bin_container *bin, 805 struct ccs_data_container *ccsdata, 806 const void *data, size_t len, struct device *dev, 807 bool verbose) 808 { 809 const struct __ccs_data_block *block = data; 810 const struct __ccs_data_block *endp = data + len; 811 unsigned int version; 812 bool is_first = true; 813 int rval; 814 815 version = ccs_data_parse_format_version(block); 816 if (version != CCS_STATIC_DATA_VERSION) { 817 dev_dbg(dev, "Don't know how to handle version %u\n", version); 818 return -EINVAL; 819 } 820 821 if (verbose) 822 dev_dbg(dev, "Parsing CCS static data version %u\n", version); 823 824 if (!bin->base) 825 *ccsdata = (struct ccs_data_container){ 0 }; 826 827 while (block < endp) { 828 const struct __ccs_data_block *next_block; 829 unsigned int block_id; 830 const void *payload; 831 832 rval = ccs_data_block_parse_header(block, is_first, &block_id, 833 &payload, &next_block, endp, 834 dev, 835 bin->base ? false : verbose); 836 837 if (rval < 0) 838 return rval; 839 840 switch (block_id) { 841 case CCS_DATA_BLOCK_ID_DUMMY: 842 break; 843 case CCS_DATA_BLOCK_ID_DATA_VERSION: 844 rval = ccs_data_parse_version(bin, ccsdata, payload, 845 next_block); 846 if (rval < 0) 847 return rval; 848 break; 849 case CCS_DATA_BLOCK_ID_SENSOR_READ_ONLY_REGS: 850 rval = ccs_data_parse_regs( 851 bin, &ccsdata->sensor_read_only_regs, 852 &ccsdata->num_sensor_read_only_regs, payload, 853 next_block, dev); 854 if (rval < 0) 855 return rval; 856 break; 857 case CCS_DATA_BLOCK_ID_SENSOR_MANUFACTURER_REGS: 858 rval = ccs_data_parse_regs( 859 bin, &ccsdata->sensor_manufacturer_regs, 860 &ccsdata->num_sensor_manufacturer_regs, payload, 861 next_block, dev); 862 if (rval < 0) 863 return rval; 864 break; 865 case CCS_DATA_BLOCK_ID_MODULE_READ_ONLY_REGS: 866 rval = ccs_data_parse_regs( 867 bin, &ccsdata->module_read_only_regs, 868 &ccsdata->num_module_read_only_regs, payload, 869 next_block, dev); 870 if (rval < 0) 871 return rval; 872 break; 873 case CCS_DATA_BLOCK_ID_MODULE_MANUFACTURER_REGS: 874 rval = ccs_data_parse_regs( 875 bin, &ccsdata->module_manufacturer_regs, 876 &ccsdata->num_module_manufacturer_regs, payload, 877 next_block, dev); 878 if (rval < 0) 879 return rval; 880 break; 881 case CCS_DATA_BLOCK_ID_SENSOR_PDAF_PIXEL_LOCATION: 882 rval = ccs_data_parse_pdaf(bin, &ccsdata->sensor_pdaf, 883 payload, next_block, dev); 884 if (rval < 0) 885 return rval; 886 break; 887 case CCS_DATA_BLOCK_ID_MODULE_PDAF_PIXEL_LOCATION: 888 rval = ccs_data_parse_pdaf(bin, &ccsdata->module_pdaf, 889 payload, next_block, dev); 890 if (rval < 0) 891 return rval; 892 break; 893 case CCS_DATA_BLOCK_ID_SENSOR_RULE_BASED_BLOCK: 894 rval = ccs_data_parse_rules( 895 bin, &ccsdata->sensor_rules, 896 &ccsdata->num_sensor_rules, payload, next_block, 897 dev); 898 if (rval < 0) 899 return rval; 900 break; 901 case CCS_DATA_BLOCK_ID_MODULE_RULE_BASED_BLOCK: 902 rval = ccs_data_parse_rules( 903 bin, &ccsdata->module_rules, 904 &ccsdata->num_module_rules, payload, next_block, 905 dev); 906 if (rval < 0) 907 return rval; 908 break; 909 case CCS_DATA_BLOCK_ID_LICENSE: 910 rval = ccs_data_parse_license(bin, &ccsdata->license, 911 &ccsdata->license_length, 912 payload, next_block); 913 if (rval < 0) 914 return rval; 915 break; 916 case CCS_DATA_BLOCK_ID_END: 917 rval = ccs_data_parse_end(&ccsdata->end, payload, 918 next_block, dev); 919 if (rval < 0) 920 return rval; 921 break; 922 default: 923 dev_dbg(dev, "WARNING: not handling block ID 0x%2.2x\n", 924 block_id); 925 } 926 927 block = next_block; 928 is_first = false; 929 } 930 931 return 0; 932 } 933 934 /** 935 * ccs_data_parse - Parse a CCS static data file into a usable in-memory 936 * data structure 937 * @ccsdata: CCS static data in-memory data structure 938 * @data: CCS static data binary 939 * @len: Length of @data 940 * @dev: Device the data is related to (used for printing debug messages) 941 * @verbose: Whether to be verbose or not 942 */ ccs_data_parse(struct ccs_data_container * ccsdata,const void * data,size_t len,struct device * dev,bool verbose)943 int ccs_data_parse(struct ccs_data_container *ccsdata, const void *data, 944 size_t len, struct device *dev, bool verbose) 945 { 946 struct bin_container bin = { 0 }; 947 int rval; 948 949 rval = __ccs_data_parse(&bin, ccsdata, data, len, dev, verbose); 950 if (rval) 951 return rval; 952 953 rval = bin_backing_alloc(&bin); 954 if (rval) 955 return rval; 956 957 rval = __ccs_data_parse(&bin, ccsdata, data, len, dev, false); 958 if (rval) 959 goto out_free; 960 961 if (verbose && ccsdata->version) 962 print_ccs_data_version(dev, ccsdata->version); 963 964 if (bin.now != bin.end) { 965 rval = -EPROTO; 966 dev_dbg(dev, "parsing mismatch; base %p; now %p; end %p\n", 967 bin.base, bin.now, bin.end); 968 goto out_free; 969 } 970 971 ccsdata->backing = bin.base; 972 973 return 0; 974 975 out_free: 976 kvfree(bin.base); 977 978 return rval; 979 } 980
