Thomas Gleixner | c942fdd | 2019-05-27 08:55:06 +0200 | [diff] [blame^] | 1 | /* SPDX-License-Identifier: GPL-2.0-or-later */ |
Theodore Kilgore | 5bdd00b | 2009-12-25 05:16:32 -0300 | [diff] [blame] | 2 | /* |
| 3 | * SN9C2028 common functions |
| 4 | * |
| 5 | * Copyright (C) 2009 Theodore Kilgore <kilgota@auburn,edu> |
| 6 | * |
| 7 | * Based closely upon the file gspca/pac_common.h |
Theodore Kilgore | 5bdd00b | 2009-12-25 05:16:32 -0300 | [diff] [blame] | 8 | */ |
| 9 | |
Vasily Khoruzhick | d8fd9f5 | 2015-04-24 04:04:04 -0300 | [diff] [blame] | 10 | static const unsigned char sn9c2028_sof_marker[] = { |
| 11 | 0xff, 0xff, 0x00, 0xc4, 0xc4, 0x96, |
| 12 | 0x00, |
| 13 | 0x00, /* seq */ |
| 14 | 0x00, |
| 15 | 0x00, |
| 16 | 0x00, /* avg luminance lower 8 bit */ |
| 17 | 0x00, /* avg luminance higher 8 bit */ |
| 18 | }; |
Theodore Kilgore | 5bdd00b | 2009-12-25 05:16:32 -0300 | [diff] [blame] | 19 | |
| 20 | static unsigned char *sn9c2028_find_sof(struct gspca_dev *gspca_dev, |
| 21 | unsigned char *m, int len) |
| 22 | { |
| 23 | struct sd *sd = (struct sd *) gspca_dev; |
| 24 | int i; |
| 25 | |
| 26 | /* Search for the SOF marker (fixed part) in the header */ |
| 27 | for (i = 0; i < len; i++) { |
Vasily Khoruzhick | d8fd9f5 | 2015-04-24 04:04:04 -0300 | [diff] [blame] | 28 | if ((m[i] == sn9c2028_sof_marker[sd->sof_read]) || |
| 29 | (sd->sof_read > 5)) { |
Theodore Kilgore | 5bdd00b | 2009-12-25 05:16:32 -0300 | [diff] [blame] | 30 | sd->sof_read++; |
Vasily Khoruzhick | d8fd9f5 | 2015-04-24 04:04:04 -0300 | [diff] [blame] | 31 | if (sd->sof_read == 11) |
| 32 | sd->avg_lum_l = m[i]; |
| 33 | if (sd->sof_read == 12) |
| 34 | sd->avg_lum = (m[i] << 8) + sd->avg_lum_l; |
Theodore Kilgore | 5bdd00b | 2009-12-25 05:16:32 -0300 | [diff] [blame] | 35 | if (sd->sof_read == sizeof(sn9c2028_sof_marker)) { |
Joe Perches | 37d5efb | 2017-09-22 15:20:33 -0400 | [diff] [blame] | 36 | gspca_dbg(gspca_dev, D_FRAM, |
| 37 | "SOF found, bytes to analyze: %u - Frame starts at byte #%u\n", |
| 38 | len, i + 1); |
Theodore Kilgore | 5bdd00b | 2009-12-25 05:16:32 -0300 | [diff] [blame] | 39 | sd->sof_read = 0; |
| 40 | return m + i + 1; |
| 41 | } |
| 42 | } else { |
| 43 | sd->sof_read = 0; |
| 44 | } |
| 45 | } |
| 46 | |
| 47 | return NULL; |
| 48 | } |