^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) 2005-2006 Micronas USA Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * This file contains code to generate a firmware image for the GO7007SB
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * encoder. Much of the firmware is read verbatim from a file, but some of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * it concerning bitrate control and other things that can be configured at
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * run-time are generated dynamically. Note that the format headers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * generated here do not affect the functioning of the encoder; they are
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * merely parroted back to the host at the start of each frame.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/time.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/firmware.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <asm/byteorder.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include "go7007-priv.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define GO7007_FW_NAME "go7007/go7007tv.bin"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) /* Constants used in the source firmware image to describe code segments */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define FLAG_MODE_MJPEG (1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define FLAG_MODE_MPEG1 (1<<1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define FLAG_MODE_MPEG2 (1<<2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define FLAG_MODE_MPEG4 (1<<3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define FLAG_MODE_H263 (1<<4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define FLAG_MODE_ALL (FLAG_MODE_MJPEG | FLAG_MODE_MPEG1 | \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) FLAG_MODE_MPEG2 | FLAG_MODE_MPEG4 | \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) FLAG_MODE_H263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define FLAG_SPECIAL (1<<8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define SPECIAL_FRM_HEAD 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define SPECIAL_BRC_CTRL 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define SPECIAL_CONFIG 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define SPECIAL_SEQHEAD 3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define SPECIAL_AV_SYNC 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define SPECIAL_FINAL 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define SPECIAL_AUDIO 6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define SPECIAL_MODET 7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) /* Little data class for creating MPEG headers bit-by-bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) struct code_gen {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) unsigned char *p; /* destination */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) u32 a; /* collects bits at the top of the variable */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) int b; /* bit position of most recently-written bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) int len; /* written out so far */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) #define CODE_GEN(name, dest) struct code_gen name = { dest, 0, 32, 0 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) #define CODE_ADD(name, val, length) do { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) name.b -= (length); \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) name.a |= (val) << name.b; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) while (name.b <= 24) { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) *name.p = name.a >> 24; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) ++name.p; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) name.a <<= 8; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) name.b += 8; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) name.len += 8; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) } \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) } while (0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) #define CODE_LENGTH(name) (name.len + (32 - name.b))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) /* Tables for creating the bitrate control data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) static const s16 converge_speed_ip[101] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 1, 1, 1, 1, 1, 1, 1, 1, 1, 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 2, 2, 2, 2, 2, 2, 2, 2, 2, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 3, 3, 3, 3, 3, 4, 4, 4, 4, 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) 5, 5, 5, 6, 6, 6, 7, 7, 8, 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 9, 10, 10, 11, 12, 13, 14, 15, 16, 17,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) 19, 20, 22, 23, 25, 27, 30, 32, 35, 38,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) 41, 45, 49, 53, 58, 63, 69, 76, 83, 91,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) 100
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) static const s16 converge_speed_ipb[101] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) 3, 3, 3, 3, 3, 4, 4, 4, 4, 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) 4, 4, 4, 4, 5, 5, 5, 5, 5, 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) 6, 6, 6, 7, 7, 7, 7, 8, 8, 9,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) 9, 9, 10, 10, 11, 12, 12, 13, 14, 14,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) 15, 16, 17, 18, 19, 20, 22, 23, 25, 26,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) 28, 30, 32, 34, 37, 40, 42, 46, 49, 53,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) 57, 61, 66, 71, 77, 83, 90, 97, 106, 115,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 125, 135, 147, 161, 175, 191, 209, 228, 249, 273,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 300
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) static const s16 LAMBDA_table[4][101] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) { 16, 16, 16, 16, 17, 17, 17, 18, 18, 18,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 19, 19, 19, 20, 20, 20, 21, 21, 22, 22,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 22, 23, 23, 24, 24, 25, 25, 25, 26, 26,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 27, 27, 28, 28, 29, 29, 30, 31, 31, 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 32, 33, 33, 34, 35, 35, 36, 37, 37, 38,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 39, 39, 40, 41, 42, 42, 43, 44, 45, 46,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 46, 47, 48, 49, 50, 51, 52, 53, 54, 55,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 56, 57, 58, 59, 60, 61, 62, 63, 64, 65,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 67, 68, 69, 70, 72, 73, 74, 76, 77, 78,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 80, 81, 83, 84, 86, 87, 89, 90, 92, 94,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 96
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 20, 20, 20, 21, 21, 21, 22, 22, 23, 23,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 23, 24, 24, 25, 25, 26, 26, 27, 27, 28,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 28, 29, 29, 30, 30, 31, 31, 32, 33, 33,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 34, 34, 35, 36, 36, 37, 38, 38, 39, 40,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 40, 41, 42, 43, 43, 44, 45, 46, 47, 48,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 48, 49, 50, 51, 52, 53, 54, 55, 56, 57,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 58, 59, 60, 61, 62, 64, 65, 66, 67, 68,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 70, 71, 72, 73, 75, 76, 78, 79, 80, 82,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 83, 85, 86, 88, 90, 91, 93, 95, 96, 98,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 100, 102, 103, 105, 107, 109, 111, 113, 115, 117,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 120
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 24, 24, 24, 25, 25, 26, 26, 27, 27, 28,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 28, 29, 29, 30, 30, 31, 31, 32, 33, 33,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 34, 34, 35, 36, 36, 37, 38, 38, 39, 40,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 41, 41, 42, 43, 44, 44, 45, 46, 47, 48,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 49, 50, 50, 51, 52, 53, 54, 55, 56, 57,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 58, 59, 60, 62, 63, 64, 65, 66, 67, 69,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 70, 71, 72, 74, 75, 76, 78, 79, 81, 82,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 84, 85, 87, 88, 90, 92, 93, 95, 97, 98,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 100, 102, 104, 106, 108, 110, 112, 114, 116, 118,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 120, 122, 124, 127, 129, 131, 134, 136, 138, 141,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 144
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 32, 32, 33, 33, 34, 34, 35, 36, 36, 37,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 38, 38, 39, 40, 41, 41, 42, 43, 44, 44,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 45, 46, 47, 48, 49, 50, 50, 51, 52, 53,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 54, 55, 56, 57, 58, 59, 60, 62, 63, 64,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 65, 66, 67, 69, 70, 71, 72, 74, 75, 76,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 78, 79, 81, 82, 84, 85, 87, 88, 90, 92,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 93, 95, 97, 98, 100, 102, 104, 106, 108, 110,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 112, 114, 116, 118, 120, 122, 124, 127, 129, 131,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 134, 136, 139, 141, 144, 146, 149, 152, 154, 157,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 160, 163, 166, 169, 172, 175, 178, 181, 185, 188,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 192
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) /* MPEG blank frame generation tables */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) enum mpeg_frame_type {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) PFRAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) BFRAME_PRE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) BFRAME_POST,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) BFRAME_BIDIR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) BFRAME_EMPTY
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) static const u32 addrinctab[33][2] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) { 0x01, 1 }, { 0x03, 3 }, { 0x02, 3 }, { 0x03, 4 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) { 0x02, 4 }, { 0x03, 5 }, { 0x02, 5 }, { 0x07, 7 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) { 0x06, 7 }, { 0x0b, 8 }, { 0x0a, 8 }, { 0x09, 8 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) { 0x08, 8 }, { 0x07, 8 }, { 0x06, 8 }, { 0x17, 10 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) { 0x16, 10 }, { 0x15, 10 }, { 0x14, 10 }, { 0x13, 10 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) { 0x12, 10 }, { 0x23, 11 }, { 0x22, 11 }, { 0x21, 11 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) { 0x20, 11 }, { 0x1f, 11 }, { 0x1e, 11 }, { 0x1d, 11 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) { 0x1c, 11 }, { 0x1b, 11 }, { 0x1a, 11 }, { 0x19, 11 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) { 0x18, 11 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) /* Standard JPEG tables */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) static const u8 default_intra_quant_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 8, 16, 19, 22, 26, 27, 29, 34,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 16, 16, 22, 24, 27, 29, 34, 37,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 19, 22, 26, 27, 29, 34, 34, 38,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 22, 22, 26, 27, 29, 34, 37, 40,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 22, 26, 27, 29, 32, 35, 40, 48,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 26, 27, 29, 32, 35, 40, 48, 58,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 26, 27, 29, 34, 38, 46, 56, 69,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 27, 29, 35, 38, 46, 56, 69, 83
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) static const u8 bits_dc_luminance[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 0, 0, 1, 5, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) static const u8 val_dc_luminance[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) static const u8 bits_dc_chrominance[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 0, 0, 3, 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) static const u8 val_dc_chrominance[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) static const u8 bits_ac_luminance[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 0, 0, 2, 1, 3, 3, 2, 4, 3, 5, 5, 4, 4, 0, 0, 1, 0x7d
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) static const u8 val_ac_luminance[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 0x01, 0x02, 0x03, 0x00, 0x04, 0x11, 0x05, 0x12,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 0x21, 0x31, 0x41, 0x06, 0x13, 0x51, 0x61, 0x07,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 0x22, 0x71, 0x14, 0x32, 0x81, 0x91, 0xa1, 0x08,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 0x23, 0x42, 0xb1, 0xc1, 0x15, 0x52, 0xd1, 0xf0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 0x24, 0x33, 0x62, 0x72, 0x82, 0x09, 0x0a, 0x16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 0x17, 0x18, 0x19, 0x1a, 0x25, 0x26, 0x27, 0x28,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 0x29, 0x2a, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 0x3a, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 0x4a, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 0x5a, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 0x6a, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 0x7a, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 0x8a, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4, 0xb5, 0xb6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3, 0xc4, 0xc5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 0xc6, 0xc7, 0xc8, 0xc9, 0xca, 0xd2, 0xd3, 0xd4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 0xd5, 0xd6, 0xd7, 0xd8, 0xd9, 0xda, 0xe1, 0xe2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8, 0xe9, 0xea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 0xf1, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 0xf9, 0xfa
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) static const u8 bits_ac_chrominance[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 0, 0, 2, 1, 2, 4, 4, 3, 4, 7, 5, 4, 4, 0, 1, 2, 0x77
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) static const u8 val_ac_chrominance[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 0x00, 0x01, 0x02, 0x03, 0x11, 0x04, 0x05, 0x21,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 0x31, 0x06, 0x12, 0x41, 0x51, 0x07, 0x61, 0x71,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 0x13, 0x22, 0x32, 0x81, 0x08, 0x14, 0x42, 0x91,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 0xa1, 0xb1, 0xc1, 0x09, 0x23, 0x33, 0x52, 0xf0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 0x15, 0x62, 0x72, 0xd1, 0x0a, 0x16, 0x24, 0x34,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 0xe1, 0x25, 0xf1, 0x17, 0x18, 0x19, 0x1a, 0x26,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 0x27, 0x28, 0x29, 0x2a, 0x35, 0x36, 0x37, 0x38,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 0x39, 0x3a, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 0x49, 0x4a, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 0x59, 0x5a, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 0x69, 0x6a, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 0x79, 0x7a, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 0x88, 0x89, 0x8a, 0x92, 0x93, 0x94, 0x95, 0x96,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 0x97, 0x98, 0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 0xa6, 0xa7, 0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 0xb5, 0xb6, 0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 0xc4, 0xc5, 0xc6, 0xc7, 0xc8, 0xc9, 0xca, 0xd2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 0xd3, 0xd4, 0xd5, 0xd6, 0xd7, 0xd8, 0xd9, 0xda,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8, 0xe9,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 0xea, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 0xf9, 0xfa
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) /* Zig-zag mapping for quant table
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) * OK, let's do this mapping on the actual table above so it doesn't have
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) * to be done on the fly.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) static const int zz[64] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 0, 1, 8, 16, 9, 2, 3, 10, 17, 24, 32, 25, 18, 11, 4, 5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 12, 19, 26, 33, 40, 48, 41, 34, 27, 20, 13, 6, 7, 14, 21, 28,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 35, 42, 49, 56, 57, 50, 43, 36, 29, 22, 15, 23, 30, 37, 44, 51,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 58, 59, 52, 45, 38, 31, 39, 46, 53, 60, 61, 54, 47, 55, 62, 63
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) static int copy_packages(__le16 *dest, u16 *src, int pkg_cnt, int space)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) int i, cnt = pkg_cnt * 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) if (space < cnt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) for (i = 0; i < cnt; ++i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) dest[i] = cpu_to_le16p(src + i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) return cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) static int mjpeg_frame_header(struct go7007 *go, unsigned char *buf, int q)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) int i, p = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) buf[p++] = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) buf[p++] = 0xd8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) buf[p++] = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) buf[p++] = 0xdb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) buf[p++] = 2 + 65;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) buf[p++] = default_intra_quant_table[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) for (i = 1; i < 64; ++i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) /* buf[p++] = (default_intra_quant_table[i] * q) >> 3; */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) buf[p++] = (default_intra_quant_table[zz[i]] * q) >> 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) buf[p++] = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) buf[p++] = 0xc0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) buf[p++] = 17;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) buf[p++] = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) buf[p++] = go->height >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) buf[p++] = go->height & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) buf[p++] = go->width >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) buf[p++] = go->width & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) buf[p++] = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) buf[p++] = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) buf[p++] = 0x22;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) buf[p++] = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) buf[p++] = 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) buf[p++] = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) buf[p++] = 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) buf[p++] = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) buf[p++] = 0xc4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) buf[p++] = 418 >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) buf[p++] = 418 & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) buf[p++] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) memcpy(buf + p, bits_dc_luminance + 1, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) p += 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) memcpy(buf + p, val_dc_luminance, sizeof(val_dc_luminance));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) p += sizeof(val_dc_luminance);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) buf[p++] = 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) memcpy(buf + p, bits_dc_chrominance + 1, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) p += 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) memcpy(buf + p, val_dc_chrominance, sizeof(val_dc_chrominance));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) p += sizeof(val_dc_chrominance);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) buf[p++] = 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) memcpy(buf + p, bits_ac_luminance + 1, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) p += 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) memcpy(buf + p, val_ac_luminance, sizeof(val_ac_luminance));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) p += sizeof(val_ac_luminance);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) buf[p++] = 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) memcpy(buf + p, bits_ac_chrominance + 1, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) p += 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) memcpy(buf + p, val_ac_chrominance, sizeof(val_ac_chrominance));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) p += sizeof(val_ac_chrominance);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) buf[p++] = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) buf[p++] = 0xda;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) buf[p++] = 12;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) buf[p++] = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) buf[p++] = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) buf[p++] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) buf[p++] = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) buf[p++] = 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) buf[p++] = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) buf[p++] = 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) buf[p++] = 63;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) buf[p++] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) return p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) static int gen_mjpeghdr_to_package(struct go7007 *go, __le16 *code, int space)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) u8 *buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) u16 mem = 0x3e00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) unsigned int addr = 0x19;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) int size = 0, i, off = 0, chunk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) buf = kzalloc(4096, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) if (buf == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) for (i = 1; i < 32; ++i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) mjpeg_frame_header(go, buf + size, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) size += 80;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) chunk = mjpeg_frame_header(go, buf + size, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) memmove(buf + size, buf + size + 80, chunk - 80);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) size += chunk - 80;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) for (i = 0; i < size; i += chunk * 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) if (space - off < 32) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) off = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) code[off + 1] = __cpu_to_le16(0x8000 | mem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) chunk = 28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) if (mem + chunk > 0x4000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) chunk = 0x4000 - mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) if (i + 2 * chunk > size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) chunk = (size - i) / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) if (chunk < 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) code[off] = __cpu_to_le16(0x4000 | chunk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) code[off + 31] = __cpu_to_le16(addr++);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) mem = 0x3e00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) code[off] = __cpu_to_le16(0x1000 | 28);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) code[off + 31] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) mem += 28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) memcpy(&code[off + 2], buf + i, chunk * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) off += 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) kfree(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) return off;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) static int mpeg1_frame_header(struct go7007 *go, unsigned char *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) int modulo, int pict_struct, enum mpeg_frame_type frame)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) int i, j, mb_code, mb_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) int rows = go->interlace_coding ? go->height / 32 : go->height / 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) CODE_GEN(c, buf + 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) switch (frame) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) case PFRAME:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) mb_code = 0x1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) mb_len = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) case BFRAME_PRE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) mb_code = 0x2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) mb_len = 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) case BFRAME_POST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) mb_code = 0x2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) mb_len = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) case BFRAME_BIDIR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) mb_code = 0x2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) mb_len = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) default: /* keep the compiler happy */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) mb_code = mb_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) CODE_ADD(c, frame == PFRAME ? 0x2 : 0x3, 13);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) CODE_ADD(c, 0xffff, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) CODE_ADD(c, go->format == V4L2_PIX_FMT_MPEG2 ? 0x7 : 0x4, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) if (frame != PFRAME)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) CODE_ADD(c, go->format == V4L2_PIX_FMT_MPEG2 ? 0x7 : 0x4, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) CODE_ADD(c, 0, 4); /* Is this supposed to be here?? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) CODE_ADD(c, 0, 3); /* What is this?? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) /* Byte-align with zeros */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) j = 8 - (CODE_LENGTH(c) % 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) if (j != 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) CODE_ADD(c, 0, j);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) if (go->format == V4L2_PIX_FMT_MPEG2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) CODE_ADD(c, 0x1, 24);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) CODE_ADD(c, 0xb5, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) CODE_ADD(c, 0x844, 12);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) CODE_ADD(c, frame == PFRAME ? 0xff : 0x44, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) if (go->interlace_coding) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) CODE_ADD(c, pict_struct, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) if (go->dvd_mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) CODE_ADD(c, 0x000, 11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) CODE_ADD(c, 0x200, 11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) CODE_ADD(c, 0x3, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) CODE_ADD(c, 0x20c, 11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) /* Byte-align with zeros */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) j = 8 - (CODE_LENGTH(c) % 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) if (j != 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) CODE_ADD(c, 0, j);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) for (i = 0; i < rows; ++i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) CODE_ADD(c, 1, 24);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) CODE_ADD(c, i + 1, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) CODE_ADD(c, 0x2, 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) CODE_ADD(c, 0x1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) CODE_ADD(c, mb_code, mb_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) if (go->interlace_coding) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) CODE_ADD(c, 0x1, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) CODE_ADD(c, pict_struct == 1 ? 0x0 : 0x1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) if (frame == BFRAME_BIDIR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) CODE_ADD(c, 0x3, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) if (go->interlace_coding)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) CODE_ADD(c, pict_struct == 1 ? 0x0 : 0x1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) CODE_ADD(c, 0x3, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) for (j = (go->width >> 4) - 2; j >= 33; j -= 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) CODE_ADD(c, 0x8, 11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) CODE_ADD(c, addrinctab[j][0], addrinctab[j][1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) CODE_ADD(c, mb_code, mb_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) if (go->interlace_coding) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) CODE_ADD(c, 0x1, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) CODE_ADD(c, pict_struct == 1 ? 0x0 : 0x1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) if (frame == BFRAME_BIDIR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) CODE_ADD(c, 0x3, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) if (go->interlace_coding)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) CODE_ADD(c, pict_struct == 1 ? 0x0 : 0x1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) CODE_ADD(c, 0x3, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) /* Byte-align with zeros */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) j = 8 - (CODE_LENGTH(c) % 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) if (j != 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) CODE_ADD(c, 0, j);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) i = CODE_LENGTH(c) + 4 * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) buf[2] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) buf[3] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) buf[4] = 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) buf[5] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) return i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) static int mpeg1_sequence_header(struct go7007 *go, unsigned char *buf, int ext)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) int i, aspect_ratio, picture_rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) CODE_GEN(c, buf + 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) if (go->format == V4L2_PIX_FMT_MPEG1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) switch (go->aspect_ratio) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) case GO7007_RATIO_4_3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) aspect_ratio = go->standard == GO7007_STD_NTSC ? 3 : 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) case GO7007_RATIO_16_9:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) aspect_ratio = go->standard == GO7007_STD_NTSC ? 5 : 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) aspect_ratio = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) switch (go->aspect_ratio) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) case GO7007_RATIO_4_3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) aspect_ratio = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) case GO7007_RATIO_16_9:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) aspect_ratio = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) aspect_ratio = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) switch (go->sensor_framerate) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) case 24000:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) picture_rate = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) case 24024:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) picture_rate = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) case 25025:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) picture_rate = go->interlace_coding ? 6 : 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) case 30000:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) picture_rate = go->interlace_coding ? 7 : 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) case 30030:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) picture_rate = go->interlace_coding ? 8 : 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) picture_rate = 5; /* 30 fps seems like a reasonable default */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) CODE_ADD(c, go->width, 12);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) CODE_ADD(c, go->height, 12);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) CODE_ADD(c, aspect_ratio, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) CODE_ADD(c, picture_rate, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) CODE_ADD(c, go->format == V4L2_PIX_FMT_MPEG2 ? 20000 : 0x3ffff, 18);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) CODE_ADD(c, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) CODE_ADD(c, go->format == V4L2_PIX_FMT_MPEG2 ? 112 : 20, 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) CODE_ADD(c, 0, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) /* Byte-align with zeros */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) i = 8 - (CODE_LENGTH(c) % 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) if (i != 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) CODE_ADD(c, 0, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) if (go->format == V4L2_PIX_FMT_MPEG2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) CODE_ADD(c, 0x1, 24);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) CODE_ADD(c, 0xb5, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) CODE_ADD(c, 0x148, 12);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) if (go->interlace_coding)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) CODE_ADD(c, 0x20001, 20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) CODE_ADD(c, 0xa0001, 20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) CODE_ADD(c, 0, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) /* Byte-align with zeros */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) i = 8 - (CODE_LENGTH(c) % 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) if (i != 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) CODE_ADD(c, 0, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) if (ext) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) CODE_ADD(c, 0x1, 24);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) CODE_ADD(c, 0xb52, 12);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) CODE_ADD(c, go->standard == GO7007_STD_NTSC ? 2 : 1, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) CODE_ADD(c, 0x105, 9);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) CODE_ADD(c, 0x505, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) CODE_ADD(c, go->width, 14);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) CODE_ADD(c, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) CODE_ADD(c, go->height, 14);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) /* Byte-align with zeros */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) i = 8 - (CODE_LENGTH(c) % 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) if (i != 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) CODE_ADD(c, 0, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) i = CODE_LENGTH(c) + 4 * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) buf[0] = i & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) buf[1] = i >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) buf[2] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) buf[3] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) buf[4] = 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) buf[5] = 0xb3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) return i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) static int gen_mpeg1hdr_to_package(struct go7007 *go,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) __le16 *code, int space, int *framelen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) u8 *buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) u16 mem = 0x3e00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) unsigned int addr = 0x19;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) int i, off = 0, chunk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) buf = kzalloc(5120, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) if (buf == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) framelen[0] = mpeg1_frame_header(go, buf, 0, 1, PFRAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) if (go->interlace_coding)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) framelen[0] += mpeg1_frame_header(go, buf + framelen[0] / 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) 0, 2, PFRAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) buf[0] = framelen[0] & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) buf[1] = framelen[0] >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) i = 368;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) framelen[1] = mpeg1_frame_header(go, buf + i, 0, 1, BFRAME_PRE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) if (go->interlace_coding)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) framelen[1] += mpeg1_frame_header(go, buf + i + framelen[1] / 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) 0, 2, BFRAME_PRE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) buf[i] = framelen[1] & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) buf[i + 1] = framelen[1] >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) i += 1632;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) framelen[2] = mpeg1_frame_header(go, buf + i, 0, 1, BFRAME_POST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) if (go->interlace_coding)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) framelen[2] += mpeg1_frame_header(go, buf + i + framelen[2] / 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) 0, 2, BFRAME_POST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) buf[i] = framelen[2] & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) buf[i + 1] = framelen[2] >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) i += 1432;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) framelen[3] = mpeg1_frame_header(go, buf + i, 0, 1, BFRAME_BIDIR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) if (go->interlace_coding)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) framelen[3] += mpeg1_frame_header(go, buf + i + framelen[3] / 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) 0, 2, BFRAME_BIDIR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) buf[i] = framelen[3] & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) buf[i + 1] = framelen[3] >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) i += 1632 + 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) mpeg1_sequence_header(go, buf + i, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) i += 40;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) for (i = 0; i < 5120; i += chunk * 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) if (space - off < 32) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) off = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) code[off + 1] = __cpu_to_le16(0x8000 | mem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) chunk = 28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) if (mem + chunk > 0x4000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) chunk = 0x4000 - mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) if (i + 2 * chunk > 5120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) chunk = (5120 - i) / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) if (chunk < 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) code[off] = __cpu_to_le16(0x4000 | chunk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) code[off + 31] = __cpu_to_le16(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) if (mem + chunk == 0x4000) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) mem = 0x3e00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) ++addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) code[off] = __cpu_to_le16(0x1000 | 28);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) code[off + 31] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) mem += 28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) memcpy(&code[off + 2], buf + i, chunk * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) off += 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) kfree(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) return off;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) static int vti_bitlen(struct go7007 *go)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) unsigned int i, max_time_incr = go->sensor_framerate / go->fps_scale;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) for (i = 31; (max_time_incr & ((1 << i) - 1)) == max_time_incr; --i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) return i + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) static int mpeg4_frame_header(struct go7007 *go, unsigned char *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) int modulo, enum mpeg_frame_type frame)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) CODE_GEN(c, buf + 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) int mb_count = (go->width >> 4) * (go->height >> 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) CODE_ADD(c, frame == PFRAME ? 0x1 : 0x2, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) if (modulo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) CODE_ADD(c, 0x1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) CODE_ADD(c, 0x1, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) CODE_ADD(c, 0, vti_bitlen(go));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) CODE_ADD(c, 0x3, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) if (frame == PFRAME)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) CODE_ADD(c, 0, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) CODE_ADD(c, 0xc, 11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) if (frame != PFRAME)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) CODE_ADD(c, 0x4, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) if (frame != BFRAME_EMPTY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) for (i = 0; i < mb_count; ++i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) switch (frame) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) case PFRAME:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) CODE_ADD(c, 0x1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) case BFRAME_PRE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) CODE_ADD(c, 0x47, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) case BFRAME_POST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) CODE_ADD(c, 0x27, 7);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) case BFRAME_BIDIR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) CODE_ADD(c, 0x5f, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) case BFRAME_EMPTY: /* keep compiler quiet */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) /* Byte-align with a zero followed by ones */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) i = 8 - (CODE_LENGTH(c) % 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) CODE_ADD(c, 0, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) CODE_ADD(c, (1 << (i - 1)) - 1, i - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) i = CODE_LENGTH(c) + 4 * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) buf[0] = i & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) buf[1] = i >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) buf[2] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) buf[3] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) buf[4] = 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) buf[5] = 0xb6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) return i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) static int mpeg4_sequence_header(struct go7007 *go, unsigned char *buf, int ext)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) const unsigned char head[] = { 0x00, 0x00, 0x01, 0xb0, go->pali,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) 0x00, 0x00, 0x01, 0xb5, 0x09,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) 0x00, 0x00, 0x01, 0x00,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) 0x00, 0x00, 0x01, 0x20, };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) int i, aspect_ratio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) int fps = go->sensor_framerate / go->fps_scale;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) CODE_GEN(c, buf + 2 + sizeof(head));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) switch (go->aspect_ratio) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) case GO7007_RATIO_4_3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) aspect_ratio = go->standard == GO7007_STD_NTSC ? 3 : 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) case GO7007_RATIO_16_9:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) aspect_ratio = go->standard == GO7007_STD_NTSC ? 5 : 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) aspect_ratio = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) memcpy(buf + 2, head, sizeof(head));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) CODE_ADD(c, 0x191, 17);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) CODE_ADD(c, aspect_ratio, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) CODE_ADD(c, 0x1, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) CODE_ADD(c, fps, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) CODE_ADD(c, 0x3, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) CODE_ADD(c, 1001, vti_bitlen(go));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) CODE_ADD(c, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) CODE_ADD(c, go->width, 13);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) CODE_ADD(c, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) CODE_ADD(c, go->height, 13);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) CODE_ADD(c, 0x2830, 14);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) /* Byte-align */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) i = 8 - (CODE_LENGTH(c) % 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) CODE_ADD(c, 0, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) CODE_ADD(c, (1 << (i - 1)) - 1, i - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) i = CODE_LENGTH(c) + sizeof(head) * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) buf[0] = i & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) buf[1] = i >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) return i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) static int gen_mpeg4hdr_to_package(struct go7007 *go,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) __le16 *code, int space, int *framelen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) u8 *buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) u16 mem = 0x3e00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) unsigned int addr = 0x19;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) int i, off = 0, chunk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) buf = kzalloc(5120, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826) if (buf == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) framelen[0] = mpeg4_frame_header(go, buf, 0, PFRAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) i = 368;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) framelen[1] = mpeg4_frame_header(go, buf + i, 0, BFRAME_PRE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) i += 1632;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) framelen[2] = mpeg4_frame_header(go, buf + i, 0, BFRAME_POST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) i += 1432;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) framelen[3] = mpeg4_frame_header(go, buf + i, 0, BFRAME_BIDIR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836) i += 1632;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) mpeg4_frame_header(go, buf + i, 0, BFRAME_EMPTY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) i += 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) mpeg4_sequence_header(go, buf + i, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) i += 40;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) for (i = 0; i < 5120; i += chunk * 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) if (space - off < 32) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) off = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) code[off + 1] = __cpu_to_le16(0x8000 | mem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) chunk = 28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) if (mem + chunk > 0x4000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) chunk = 0x4000 - mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) if (i + 2 * chunk > 5120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) chunk = (5120 - i) / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) if (chunk < 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) code[off] = __cpu_to_le16(0x4000 | chunk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857) code[off + 31] = __cpu_to_le16(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) if (mem + chunk == 0x4000) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859) mem = 0x3e00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) ++addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) code[off] = __cpu_to_le16(0x1000 | 28);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) code[off + 31] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) mem += 28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) memcpy(&code[off + 2], buf + i, chunk * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) off += 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) mem = 0x3e00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) addr = go->ipb ? 0x14f9 : 0x0af9;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) memset(buf, 0, 5120);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) framelen[4] = mpeg4_frame_header(go, buf, 1, PFRAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875) i = 368;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) framelen[5] = mpeg4_frame_header(go, buf + i, 1, BFRAME_PRE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) i += 1632;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) framelen[6] = mpeg4_frame_header(go, buf + i, 1, BFRAME_POST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) i += 1432;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) framelen[7] = mpeg4_frame_header(go, buf + i, 1, BFRAME_BIDIR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) i += 1632;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) mpeg4_frame_header(go, buf + i, 1, BFRAME_EMPTY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) i += 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884) for (i = 0; i < 5120; i += chunk * 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) if (space - off < 32) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) off = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) code[off + 1] = __cpu_to_le16(0x8000 | mem);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892) chunk = 28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) if (mem + chunk > 0x4000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) chunk = 0x4000 - mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) if (i + 2 * chunk > 5120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) chunk = (5120 - i) / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) if (chunk < 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899) code[off] = __cpu_to_le16(0x4000 | chunk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900) code[off + 31] = __cpu_to_le16(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901) if (mem + chunk == 0x4000) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902) mem = 0x3e00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903) ++addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906) code[off] = __cpu_to_le16(0x1000 | 28);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) code[off + 31] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908) mem += 28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911) memcpy(&code[off + 2], buf + i, chunk * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912) off += 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915) kfree(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916) return off;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 919) static int brctrl_to_package(struct go7007 *go,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 920) __le16 *code, int space, int *framelen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 921) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 922) int converge_speed = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 923) int lambda = (go->format == V4L2_PIX_FMT_MJPEG || go->dvd_mode) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 924) 100 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 925) int peak_rate = 6 * go->bitrate / 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 926) int vbv_buffer = go->format == V4L2_PIX_FMT_MJPEG ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 927) go->bitrate :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 928) (go->dvd_mode ? 900000 : peak_rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 929) int fps = go->sensor_framerate / go->fps_scale;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 930) int q = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 931) /* Bizarre math below depends on rounding errors in division */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 932) u32 sgop_expt_addr = go->bitrate / 32 * (go->ipb ? 3 : 1) * 1001 / fps;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 933) u32 sgop_peak_addr = peak_rate / 32 * 1001 / fps;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 934) u32 total_expt_addr = go->bitrate / 32 * 1000 / fps * (fps / 1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 935) u32 vbv_alert_addr = vbv_buffer * 3 / (4 * 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 936) u32 cplx[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 937) q > 0 ? sgop_expt_addr * q :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 938) 2 * go->width * go->height * (go->ipb ? 6 : 4) / 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 939) q > 0 ? sgop_expt_addr * q :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 940) 2 * go->width * go->height * (go->ipb ? 6 : 4) / 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 941) q > 0 ? sgop_expt_addr * q :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 942) 2 * go->width * go->height * (go->ipb ? 6 : 4) / 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 943) q > 0 ? sgop_expt_addr * q :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 944) 2 * go->width * go->height * (go->ipb ? 6 : 4) / 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 945) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 946) u32 calc_q = q > 0 ? q : cplx[0] / sgop_expt_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 947) u16 pack[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 948) 0x200e, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 949) 0xBF20, go->ipb ? converge_speed_ipb[converge_speed]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 950) : converge_speed_ip[converge_speed],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 951) 0xBF21, go->ipb ? 2 : 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 952) 0xBF22, go->ipb ? LAMBDA_table[0][lambda / 2 + 50]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 953) : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 954) 0xBF23, go->ipb ? LAMBDA_table[1][lambda] : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 955) 0xBF24, 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 956) 0xBF25, lambda > 99 ? 32767 : LAMBDA_table[3][lambda],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 957) 0xBF26, sgop_expt_addr & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 958) 0xBF27, sgop_expt_addr >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 959) 0xBF28, sgop_peak_addr & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 960) 0xBF29, sgop_peak_addr >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 961) 0xBF2A, vbv_alert_addr & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 962) 0xBF2B, vbv_alert_addr >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 963) 0xBF2C, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 964) 0xBF2D, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 965) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 966)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 967) 0x200e, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 968) 0xBF2E, vbv_alert_addr & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 969) 0xBF2F, vbv_alert_addr >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 970) 0xBF30, cplx[0] & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 971) 0xBF31, cplx[0] >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 972) 0xBF32, cplx[1] & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 973) 0xBF33, cplx[1] >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 974) 0xBF34, cplx[2] & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 975) 0xBF35, cplx[2] >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 976) 0xBF36, cplx[3] & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 977) 0xBF37, cplx[3] >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 978) 0xBF38, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 979) 0xBF39, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 980) 0xBF3A, total_expt_addr & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 981) 0xBF3B, total_expt_addr >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 982) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 983)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 984) 0x200e, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 985) 0xBF3C, total_expt_addr & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 986) 0xBF3D, total_expt_addr >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 987) 0xBF3E, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 988) 0xBF3F, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 989) 0xBF48, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 990) 0xBF49, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 991) 0xBF4A, calc_q < 4 ? 4 : (calc_q > 124 ? 124 : calc_q),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 992) 0xBF4B, 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 993) 0xBF4C, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 994) 0xBF4D, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 995) 0xBF4E, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 996) 0xBF4F, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 997) 0xBF50, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 998) 0xBF51, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 999) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1001) 0x200e, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1002) 0xBF40, sgop_expt_addr & 0x0000FFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1003) 0xBF41, sgop_expt_addr >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1004) 0xBF42, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1005) 0xBF43, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1006) 0xBF44, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1007) 0xBF45, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1008) 0xBF46, (go->width >> 4) * (go->height >> 4),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1009) 0xBF47, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1010) 0xBF64, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1011) 0xBF65, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1012) 0xBF18, framelen[4],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1013) 0xBF19, framelen[5],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1014) 0xBF1A, framelen[6],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1015) 0xBF1B, framelen[7],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1016) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1017)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1018) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1019) /* Remove once we don't care about matching */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1020) 0x200e, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1021) 0xBF56, 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1022) 0xBF57, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1023) 0xBF58, 5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1024) 0xBF59, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1025) 0xBF5A, 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1026) 0xBF5B, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1027) 0xBF5C, 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1028) 0xBF5D, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1029) 0xBF5E, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1030) 0xBF5F, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1031) 0xBF60, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1032) 0xBF61, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1033) 0xBF62, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1034) 0xBF63, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1035) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1036) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1037) 0x2008, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1038) 0xBF56, 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1039) 0xBF57, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1040) 0xBF58, 5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1041) 0xBF59, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1042) 0xBF5A, 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1043) 0xBF5B, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1044) 0xBF5C, 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1045) 0xBF5D, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1046) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1047) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1048) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1049) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1050) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1051) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1052) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1053) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1054)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1055) 0x200e, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1056) 0xBF10, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1057) 0xBF11, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1058) 0xBF12, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1059) 0xBF13, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1060) 0xBF14, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1061) 0xBF15, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1062) 0xBF16, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1063) 0xBF17, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1064) 0xBF7E, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1065) 0xBF7F, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1066) 0xBF52, framelen[0],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1067) 0xBF53, framelen[1],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1068) 0xBF54, framelen[2],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1069) 0xBF55, framelen[3],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1070) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1071) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1072)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1073) return copy_packages(code, pack, 6, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1074) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1075)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1076) static int config_package(struct go7007 *go, __le16 *code, int space)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1077) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1078) int fps = go->sensor_framerate / go->fps_scale / 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1079) int rows = go->interlace_coding ? go->height / 32 : go->height / 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1080) int brc_window_size = fps;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1081) int q_min = 2, q_max = 31;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1082) int THACCoeffSet0 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1083) u16 pack[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1084) 0x200e, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1085) 0xc002, 0x14b4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1086) 0xc003, 0x28b4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1087) 0xc004, 0x3c5a,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1088) 0xdc05, 0x2a77,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1089) 0xc6c3, go->format == V4L2_PIX_FMT_MPEG4 ? 0 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1090) (go->format == V4L2_PIX_FMT_H263 ? 0 : 1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1091) 0xc680, go->format == V4L2_PIX_FMT_MPEG4 ? 0xf1 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1092) (go->format == V4L2_PIX_FMT_H263 ? 0x61 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1093) 0xd3),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1094) 0xc780, 0x0140,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1095) 0xe009, 0x0001,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1096) 0xc60f, 0x0008,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1097) 0xd4ff, 0x0002,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1098) 0xe403, 2340,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1099) 0xe406, 75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1100) 0xd411, 0x0001,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1101) 0xd410, 0xa1d6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1102) 0x0001, 0x2801,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1104) 0x200d, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1105) 0xe402, 0x018b,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1106) 0xe401, 0x8b01,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1107) 0xd472, (go->board_info->sensor_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1108) GO7007_SENSOR_TV) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1109) (!go->interlace_coding) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1110) 0x01b0 : 0x0170,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1111) 0xd475, (go->board_info->sensor_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1112) GO7007_SENSOR_TV) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1113) (!go->interlace_coding) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1114) 0x0008 : 0x0009,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1115) 0xc404, go->interlace_coding ? 0x44 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1116) (go->format == V4L2_PIX_FMT_MPEG4 ? 0x11 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1117) (go->format == V4L2_PIX_FMT_MPEG1 ? 0x02 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1118) (go->format == V4L2_PIX_FMT_MPEG2 ? 0x04 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1119) (go->format == V4L2_PIX_FMT_H263 ? 0x08 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1120) 0x20)))),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1121) 0xbf0a, (go->format == V4L2_PIX_FMT_MPEG4 ? 8 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1122) (go->format == V4L2_PIX_FMT_MPEG1 ? 1 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1123) (go->format == V4L2_PIX_FMT_MPEG2 ? 2 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1124) (go->format == V4L2_PIX_FMT_H263 ? 4 : 16)))) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1125) ((go->repeat_seqhead ? 1 : 0) << 6) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1126) ((go->dvd_mode ? 1 : 0) << 9) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1127) ((go->gop_header_enable ? 1 : 0) << 10),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1128) 0xbf0b, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1129) 0xdd5a, go->ipb ? 0x14 : 0x0a,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1130) 0xbf0c, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1131) 0xbf0d, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1132) 0xc683, THACCoeffSet0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1133) 0xc40a, (go->width << 4) | rows,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1134) 0xe01a, go->board_info->hpi_buffer_cap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1135) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1136) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1138) 0x2008, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1139) 0xe402, 0x88,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1140) 0xe401, 0x8f01,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1141) 0xbf6a, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1142) 0xbf6b, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1143) 0xbf6c, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1144) 0xbf6d, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1145) 0xbf6e, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1146) 0xbf6f, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1147) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1148) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1149) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1150) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1151) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1152) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1153) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1155) 0x200e, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1156) 0xbf66, brc_window_size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1157) 0xbf67, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1158) 0xbf68, q_min,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1159) 0xbf69, q_max,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1160) 0xbfe0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1161) 0xbfe1, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1162) 0xbfe2, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1163) 0xbfe3, go->ipb ? 3 : 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1164) 0xc031, go->board_info->sensor_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1165) GO7007_SENSOR_VBI ? 1 : 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1166) 0xc01c, 0x1f,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1167) 0xdd8c, 0x15,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1168) 0xdd94, 0x15,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1169) 0xdd88, go->ipb ? 0x1401 : 0x0a01,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1170) 0xdd90, go->ipb ? 0x1401 : 0x0a01,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1171) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1173) 0x200e, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1174) 0xbfe4, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1175) 0xbfe5, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1176) 0xbfe6, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1177) 0xbfe7, fps << 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1178) 0xbfe8, 0x3a00,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1179) 0xbfe9, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1180) 0xbfea, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1181) 0xbfeb, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1182) 0xbfec, (go->interlace_coding ? 1 << 15 : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1183) (go->modet_enable ? 0xa : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1184) (go->board_info->sensor_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1185) GO7007_SENSOR_VBI ? 1 : 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1186) 0xbfed, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1187) 0xbfee, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1188) 0xbfef, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1189) 0xbff0, go->board_info->sensor_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1190) GO7007_SENSOR_TV ? 0xf060 : 0xb060,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1191) 0xbff1, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1192) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1193) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1195) return copy_packages(code, pack, 5, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1198) static int seqhead_to_package(struct go7007 *go, __le16 *code, int space,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1199) int (*sequence_header_func)(struct go7007 *go,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1200) unsigned char *buf, int ext))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1201) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1202) int vop_time_increment_bitlength = vti_bitlen(go);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1203) int fps = go->sensor_framerate / go->fps_scale *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1204) (go->interlace_coding ? 2 : 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1205) unsigned char buf[40] = { };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1206) int len = sequence_header_func(go, buf, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1207) u16 pack[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1208) 0x2006, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1209) 0xbf08, fps,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1210) 0xbf09, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1211) 0xbff2, vop_time_increment_bitlength,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1212) 0xbff3, (1 << vop_time_increment_bitlength) - 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1213) 0xbfe6, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1214) 0xbfe7, (fps / 1000) << 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1215) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1216) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1217) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1218) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1219) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1220) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1221) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1222) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1223) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1225) 0x2007, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1226) 0xc800, buf[2] << 8 | buf[3],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1227) 0xc801, buf[4] << 8 | buf[5],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1228) 0xc802, buf[6] << 8 | buf[7],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1229) 0xc803, buf[8] << 8 | buf[9],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1230) 0xc406, 64,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1231) 0xc407, len - 64,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1232) 0xc61b, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1233) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1234) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1235) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1236) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1237) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1238) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1239) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1240) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1242) 0x200e, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1243) 0xc808, buf[10] << 8 | buf[11],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1244) 0xc809, buf[12] << 8 | buf[13],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1245) 0xc80a, buf[14] << 8 | buf[15],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1246) 0xc80b, buf[16] << 8 | buf[17],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1247) 0xc80c, buf[18] << 8 | buf[19],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1248) 0xc80d, buf[20] << 8 | buf[21],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1249) 0xc80e, buf[22] << 8 | buf[23],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1250) 0xc80f, buf[24] << 8 | buf[25],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1251) 0xc810, buf[26] << 8 | buf[27],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1252) 0xc811, buf[28] << 8 | buf[29],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1253) 0xc812, buf[30] << 8 | buf[31],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1254) 0xc813, buf[32] << 8 | buf[33],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1255) 0xc814, buf[34] << 8 | buf[35],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1256) 0xc815, buf[36] << 8 | buf[37],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1257) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1258) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1259) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1260) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1262) return copy_packages(code, pack, 3, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1263) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1265) static int relative_prime(int big, int little)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1266) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1267) int remainder;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1269) while (little != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1270) remainder = big % little;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1271) big = little;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1272) little = remainder;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1273) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1274) return big;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1275) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1277) static int avsync_to_package(struct go7007 *go, __le16 *code, int space)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1278) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1279) int arate = go->board_info->audio_rate * 1001 * go->fps_scale;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1280) int ratio = arate / go->sensor_framerate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1281) int adjratio = ratio * 215 / 100;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1282) int rprime = relative_prime(go->sensor_framerate,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1283) arate % go->sensor_framerate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1284) int f1 = (arate % go->sensor_framerate) / rprime;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1285) int f2 = (go->sensor_framerate - arate % go->sensor_framerate) / rprime;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1286) u16 pack[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1287) 0x200e, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1288) 0xbf98, (u16)((-adjratio) & 0xffff),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1289) 0xbf99, (u16)((-adjratio) >> 16),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1290) 0xbf92, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1291) 0xbf93, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1292) 0xbff4, f1 > f2 ? f1 : f2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1293) 0xbff5, f1 < f2 ? f1 : f2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1294) 0xbff6, f1 < f2 ? ratio : ratio + 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1295) 0xbff7, f1 > f2 ? ratio : ratio + 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1296) 0xbff8, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1297) 0xbff9, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1298) 0xbffa, adjratio & 0xffff,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1299) 0xbffb, adjratio >> 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1300) 0xbf94, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1301) 0xbf95, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1302) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1303) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1305) return copy_packages(code, pack, 1, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1308) static int final_package(struct go7007 *go, __le16 *code, int space)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1309) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1310) int rows = go->interlace_coding ? go->height / 32 : go->height / 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1311) u16 pack[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1312) 0x8000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1313) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1314) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1315) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1316) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1317) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1318) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1319) 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1320) ((go->board_info->sensor_flags & GO7007_SENSOR_TV) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1321) (!go->interlace_coding) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1322) (1 << 14) | (1 << 9) : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1323) ((go->encoder_subsample ? 1 : 0) << 8) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1324) (go->board_info->sensor_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1325) GO7007_SENSOR_CONFIG_MASK),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1326) ((go->encoder_v_halve ? 1 : 0) << 14) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1327) (go->encoder_v_halve ? rows << 9 : rows << 8) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1328) (go->encoder_h_halve ? 1 << 6 : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1329) (go->encoder_h_halve ? go->width >> 3 : go->width >> 4),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1330) (1 << 15) | (go->encoder_v_offset << 6) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1331) (1 << 7) | (go->encoder_h_offset >> 2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1332) (1 << 6),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1333) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1334) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1335) ((go->fps_scale - 1) << 8) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1336) (go->board_info->sensor_flags & GO7007_SENSOR_TV ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1337) (1 << 7) : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1338) 0x41,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1339) go->ipb ? 0xd4c : 0x36b,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1340) (rows << 8) | (go->width >> 4),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1341) go->format == V4L2_PIX_FMT_MPEG4 ? 0x0404 : 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1342) (1 << 15) | ((go->interlace_coding ? 1 : 0) << 13) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1343) ((go->closed_gop ? 1 : 0) << 12) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1344) ((go->format == V4L2_PIX_FMT_MPEG4 ? 1 : 0) << 11) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1345) /* (1 << 9) | */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1346) ((go->ipb ? 3 : 0) << 7) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1347) ((go->modet_enable ? 1 : 0) << 2) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1348) ((go->dvd_mode ? 1 : 0) << 1) | 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1349) (go->format == V4L2_PIX_FMT_MPEG1 ? 0x89a0 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1350) (go->format == V4L2_PIX_FMT_MPEG2 ? 0x89a0 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1351) (go->format == V4L2_PIX_FMT_MJPEG ? 0x89a0 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1352) (go->format == V4L2_PIX_FMT_MPEG4 ? 0x8920 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1353) (go->format == V4L2_PIX_FMT_H263 ? 0x8920 : 0))))),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1354) go->ipb ? 0x1f15 : 0x1f0b,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1355) go->ipb ? 0x0015 : 0x000b,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1356) go->ipb ? 0xa800 : 0x5800,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1357) 0xffff,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1358) 0x0020 + 0x034b * 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1359) 0x0020 + 0x034b * 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1360) 0x0020 + 0x034b * 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1361) 0x0020 + 0x034b * 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1362) 0x0020 + 0x034b * 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1363) 0x0020 + 0x034b * 5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1364) go->ipb ? (go->gop_size / 3) : go->gop_size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1365) (go->height >> 4) * (go->width >> 4) * 110 / 100,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1366) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1368) return copy_packages(code, pack, 1, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1369) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1371) static int audio_to_package(struct go7007 *go, __le16 *code, int space)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1372) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1373) int clock_config = ((go->board_info->audio_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1374) GO7007_AUDIO_I2S_MASTER ? 1 : 0) << 11) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1375) ((go->board_info->audio_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1376) GO7007_AUDIO_OKI_MODE ? 1 : 0) << 8) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1377) (((go->board_info->audio_bclk_div / 4) - 1) << 4) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1378) (go->board_info->audio_main_div - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1379) u16 pack[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1380) 0x200d, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1381) 0x9002, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1382) 0x9002, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1383) 0x9031, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1384) 0x9032, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1385) 0x9033, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1386) 0x9034, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1387) 0x9035, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1388) 0x9036, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1389) 0x9037, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1390) 0x9040, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1391) 0x9000, clock_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1392) 0x9001, (go->board_info->audio_flags & 0xffff) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1393) (1 << 9),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1394) 0x9000, ((go->board_info->audio_flags &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1395) GO7007_AUDIO_I2S_MASTER ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1396) 1 : 0) << 10) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1397) clock_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1398) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1399) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1400) 0x2005, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1401) 0x9041, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1402) 0x9042, 256,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1403) 0x9043, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1404) 0x9044, 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1405) 0x9045, 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1406) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1407) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1408) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1409) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1410) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1411) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1412) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1413) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1414) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1415) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1416) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1417)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1418) return copy_packages(code, pack, 2, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1419) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1420)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1421) static int modet_to_package(struct go7007 *go, __le16 *code, int space)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1422) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1423) bool has_modet0 = go->modet[0].enable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1424) bool has_modet1 = go->modet[1].enable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1425) bool has_modet2 = go->modet[2].enable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1426) bool has_modet3 = go->modet[3].enable;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1427) int ret, mb, i, addr, cnt = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1428) u16 pack[32];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1429) u16 thresholds[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1430) 0x200e, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1431) 0xbf82, has_modet0 ? go->modet[0].pixel_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1432) 0xbf83, has_modet1 ? go->modet[1].pixel_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1433) 0xbf84, has_modet2 ? go->modet[2].pixel_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1434) 0xbf85, has_modet3 ? go->modet[3].pixel_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1435) 0xbf86, has_modet0 ? go->modet[0].motion_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1436) 0xbf87, has_modet1 ? go->modet[1].motion_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1437) 0xbf88, has_modet2 ? go->modet[2].motion_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1438) 0xbf89, has_modet3 ? go->modet[3].motion_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1439) 0xbf8a, has_modet0 ? go->modet[0].mb_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1440) 0xbf8b, has_modet1 ? go->modet[1].mb_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1441) 0xbf8c, has_modet2 ? go->modet[2].mb_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1442) 0xbf8d, has_modet3 ? go->modet[3].mb_threshold : 32767,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1443) 0xbf8e, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1444) 0xbf8f, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1445) 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1446) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1448) ret = copy_packages(code, thresholds, 1, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1449) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1450) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1451) cnt += ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1452)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1453) addr = 0xbac0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1454) memset(pack, 0, 64);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1455) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1456) for (mb = 0; mb < 1624; ++mb) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1457) pack[i * 2 + 3] <<= 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1458) pack[i * 2 + 3] |= go->modet_map[mb];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1459) if (mb % 8 != 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1460) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1461) pack[i * 2 + 2] = addr++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1462) ++i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1463) if (i == 10 || mb == 1623) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1464) pack[0] = 0x2000 | i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1465) ret = copy_packages(code + cnt, pack, 1, space - cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1466) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1467) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1468) cnt += ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1469) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1470) memset(pack, 0, 64);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1471) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1472) pack[i * 2 + 3] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1473) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1475) memset(pack, 0, 64);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1476) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1477) for (addr = 0xbb90; addr < 0xbbfa; ++addr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1478) pack[i * 2 + 2] = addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1479) pack[i * 2 + 3] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1480) ++i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1481) if (i == 10 || addr == 0xbbf9) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1482) pack[0] = 0x2000 | i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1483) ret = copy_packages(code + cnt, pack, 1, space - cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1484) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1485) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1486) cnt += ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1487) i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1488) memset(pack, 0, 64);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1489) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1490) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1491) return cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1492) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1493)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1494) static noinline_for_stack int do_special(struct go7007 *go, u16 type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1495) __le16 *code, int space, int *framelen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1496) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1497) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1498) case SPECIAL_FRM_HEAD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1499) switch (go->format) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1500) case V4L2_PIX_FMT_MJPEG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1501) return gen_mjpeghdr_to_package(go, code, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1502) case V4L2_PIX_FMT_MPEG1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1503) case V4L2_PIX_FMT_MPEG2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1504) return gen_mpeg1hdr_to_package(go, code, space,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1505) framelen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1506) case V4L2_PIX_FMT_MPEG4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1507) return gen_mpeg4hdr_to_package(go, code, space,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1508) framelen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1509) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1510) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1511) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1512) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1513) case SPECIAL_BRC_CTRL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1514) return brctrl_to_package(go, code, space, framelen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1515) case SPECIAL_CONFIG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1516) return config_package(go, code, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1517) case SPECIAL_SEQHEAD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1518) switch (go->format) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1519) case V4L2_PIX_FMT_MPEG1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1520) case V4L2_PIX_FMT_MPEG2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1521) return seqhead_to_package(go, code, space,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1522) mpeg1_sequence_header);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1523) case V4L2_PIX_FMT_MPEG4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1524) return seqhead_to_package(go, code, space,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1525) mpeg4_sequence_header);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1526) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1527) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1528) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1529) case SPECIAL_AV_SYNC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1530) return avsync_to_package(go, code, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1531) case SPECIAL_FINAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1532) return final_package(go, code, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1533) case SPECIAL_AUDIO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1534) return audio_to_package(go, code, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1535) case SPECIAL_MODET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1536) return modet_to_package(go, code, space);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1537) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1538) dev_err(go->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1539) "firmware file contains unsupported feature %04x\n", type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1540) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1541) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1542)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1543) int go7007_construct_fw_image(struct go7007 *go, u8 **fw, int *fwlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1544) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1545) const struct firmware *fw_entry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1546) __le16 *code, *src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1547) int framelen[8] = { }; /* holds the lengths of empty frame templates */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1548) int codespace = 64 * 1024, i = 0, srclen, chunk_len, chunk_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1549) int mode_flag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1550) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1551)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1552) switch (go->format) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1553) case V4L2_PIX_FMT_MJPEG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1554) mode_flag = FLAG_MODE_MJPEG;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1555) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1556) case V4L2_PIX_FMT_MPEG1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1557) mode_flag = FLAG_MODE_MPEG1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1558) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1559) case V4L2_PIX_FMT_MPEG2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1560) mode_flag = FLAG_MODE_MPEG2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1561) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1562) case V4L2_PIX_FMT_MPEG4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1563) mode_flag = FLAG_MODE_MPEG4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1564) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1565) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1566) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1567) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1568) if (request_firmware(&fw_entry, GO7007_FW_NAME, go->dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1569) dev_err(go->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1570) "unable to load firmware from file \"%s\"\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1571) GO7007_FW_NAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1572) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1573) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1574) code = kcalloc(codespace, 2, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1575) if (code == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1576) goto fw_failed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1577)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1578) src = (__le16 *)fw_entry->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1579) srclen = fw_entry->size / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1580) while (srclen >= 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1581) chunk_flags = __le16_to_cpu(src[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1582) chunk_len = __le16_to_cpu(src[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1583) if (chunk_len + 2 > srclen) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1584) dev_err(go->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1585) "firmware file \"%s\" appears to be corrupted\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1586) GO7007_FW_NAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1587) goto fw_failed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1588) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1589) if (chunk_flags & mode_flag) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1590) if (chunk_flags & FLAG_SPECIAL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1591) ret = do_special(go, __le16_to_cpu(src[2]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1592) &code[i], codespace - i, framelen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1593) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1594) dev_err(go->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1595) "insufficient memory for firmware construction\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1596) goto fw_failed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1597) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1598) i += ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1599) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1600) if (codespace - i < chunk_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1601) dev_err(go->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1602) "insufficient memory for firmware construction\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1603) goto fw_failed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1604) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1605) memcpy(&code[i], &src[2], chunk_len * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1606) i += chunk_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1607) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1608) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1609) srclen -= chunk_len + 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1610) src += chunk_len + 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1611) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1612) release_firmware(fw_entry);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1613) *fw = (u8 *)code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1614) *fwlen = i * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1615) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1616)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1617) fw_failed:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1618) kfree(code);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1619) release_firmware(fw_entry);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1620) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1621) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1622)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1623) MODULE_FIRMWARE(GO7007_FW_NAME);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags