xref: /OK3568_Linux_fs/kernel/drivers/media/platform/coda/coda-mpeg4.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Coda multi-standard codec IP - MPEG-4 helper functions
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2019 Pengutronix, Philipp Zabel
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include <linux/kernel.h>
9*4882a593Smuzhiyun #include <linux/videodev2.h>
10*4882a593Smuzhiyun 
11*4882a593Smuzhiyun #include "coda.h"
12*4882a593Smuzhiyun 
coda_mpeg4_profile(int profile_idc)13*4882a593Smuzhiyun int coda_mpeg4_profile(int profile_idc)
14*4882a593Smuzhiyun {
15*4882a593Smuzhiyun 	switch (profile_idc) {
16*4882a593Smuzhiyun 	case 0:
17*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_PROFILE_SIMPLE;
18*4882a593Smuzhiyun 	case 15:
19*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_PROFILE_ADVANCED_SIMPLE;
20*4882a593Smuzhiyun 	case 2:
21*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_PROFILE_CORE;
22*4882a593Smuzhiyun 	case 1:
23*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_PROFILE_SIMPLE_SCALABLE;
24*4882a593Smuzhiyun 	case 11:
25*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_PROFILE_ADVANCED_CODING_EFFICIENCY;
26*4882a593Smuzhiyun 	default:
27*4882a593Smuzhiyun 		return -EINVAL;
28*4882a593Smuzhiyun 	}
29*4882a593Smuzhiyun }
30*4882a593Smuzhiyun 
coda_mpeg4_level(int level_idc)31*4882a593Smuzhiyun int coda_mpeg4_level(int level_idc)
32*4882a593Smuzhiyun {
33*4882a593Smuzhiyun 	switch (level_idc) {
34*4882a593Smuzhiyun 	case 0:
35*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_LEVEL_0;
36*4882a593Smuzhiyun 	case 1:
37*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_LEVEL_1;
38*4882a593Smuzhiyun 	case 2:
39*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_LEVEL_2;
40*4882a593Smuzhiyun 	case 3:
41*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_LEVEL_3;
42*4882a593Smuzhiyun 	case 4:
43*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_LEVEL_4;
44*4882a593Smuzhiyun 	case 5:
45*4882a593Smuzhiyun 		return V4L2_MPEG_VIDEO_MPEG4_LEVEL_5;
46*4882a593Smuzhiyun 	default:
47*4882a593Smuzhiyun 		return -EINVAL;
48*4882a593Smuzhiyun 	}
49*4882a593Smuzhiyun }
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun /*
52*4882a593Smuzhiyun  * Check if the buffer starts with the MPEG-4 visual object sequence and visual
53*4882a593Smuzhiyun  * object headers, for example:
54*4882a593Smuzhiyun  *
55*4882a593Smuzhiyun  *   00 00 01 b0 f1
56*4882a593Smuzhiyun  *   00 00 01 b5 a9 13 00 00 01 00 00 00 01 20 08
57*4882a593Smuzhiyun  *               d4 8d 88 00 f5 04 04 08 14 30 3f
58*4882a593Smuzhiyun  *
59*4882a593Smuzhiyun  * Returns the detected header size in bytes or 0.
60*4882a593Smuzhiyun  */
coda_mpeg4_parse_headers(struct coda_ctx * ctx,u8 * buf,u32 size)61*4882a593Smuzhiyun u32 coda_mpeg4_parse_headers(struct coda_ctx *ctx, u8 *buf, u32 size)
62*4882a593Smuzhiyun {
63*4882a593Smuzhiyun 	static const u8 vos_start[4] = { 0x00, 0x00, 0x01, 0xb0 };
64*4882a593Smuzhiyun 	static const union {
65*4882a593Smuzhiyun 		u8 vo_start[4];
66*4882a593Smuzhiyun 		u8 start_code_prefix[3];
67*4882a593Smuzhiyun 	} u = { { 0x00, 0x00, 0x01, 0xb5 } };
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun 	if (size < 30 ||
70*4882a593Smuzhiyun 	    memcmp(buf, vos_start, 4) != 0 ||
71*4882a593Smuzhiyun 	    memcmp(buf + 5, u.vo_start, 4) != 0)
72*4882a593Smuzhiyun 		return 0;
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun 	if (size == 30 ||
75*4882a593Smuzhiyun 	    (size >= 33 && memcmp(buf + 30, u.start_code_prefix, 3) == 0))
76*4882a593Smuzhiyun 		return 30;
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	if (size == 31 ||
79*4882a593Smuzhiyun 	    (size >= 34 && memcmp(buf + 31, u.start_code_prefix, 3) == 0))
80*4882a593Smuzhiyun 		return 31;
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 	if (size == 32 ||
83*4882a593Smuzhiyun 	    (size >= 35 && memcmp(buf + 32, u.start_code_prefix, 3) == 0))
84*4882a593Smuzhiyun 		return 32;
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun 	return 0;
87*4882a593Smuzhiyun }
88