More misc wma fixes.
[paraslash.git] / wma_common.c
1 /*
2 * Copyright (C) 2009 Andre Noll <maan@systemlinux.org>
3 *
4 * Licensed under the GPL v2. For licencing details see COPYING.
5 */
6
7 /** \file wma_common.c Functions used by both the WMA afh and decoder. */
8
9 #include <inttypes.h>
10 #include <sys/types.h>
11 #include <sys/stat.h>
12 #include <fcntl.h>
13 #include <stdio.h>
14 #include <unistd.h>
15 #include <string.h>
16
17 #include "para.h"
18 #include "error.h"
19 #include "afh.h"
20 #include "portable_io.h"
21 #include "imdct.h"
22 #include "wma.h"
23
24 const char *search_pattern(const char *pattern, int pattern_len, const char *buf, int buf_size)
25 {
26 const char *p, *end = buf + buf_size;
27
28 if (pattern_len > buf_size)
29 return NULL;
30 for (p = buf; p + pattern_len < end; p++) {
31 if (memcmp(p, pattern, pattern_len))
32 continue;
33 PARA_DEBUG_LOG("found %d byte pattern@%d\n",
34 pattern_len, p - buf);
35 return p;
36 }
37 PARA_NOTICE_LOG("%d byte pattern not found\n", pattern_len);
38 return NULL;
39 }
40
41 /*
42 40 9e 69 f8 4d 5b cf 11 a8 fd 00 80 5f 5c 44 2b
43 */
44 static int find_audio_stream_info(const char *buf, int len)
45 {
46 const char pattern[] = {0x40, 0x9e, 0x69, 0xf8};
47 const char *p = search_pattern(pattern, sizeof(pattern), buf, len);
48
49 if (!p)
50 return -E_WMA_NO_GUID;
51 PARA_DEBUG_LOG("found audio stream guid@%0zx\n", p - buf);
52 return p - buf;
53 }
54
55 static int read_header_len(char *buf, int len)
56 {
57 uint16_t header_len;
58
59 if (len < 18)
60 return 0;
61 header_len = read_u16(buf + 16) + 46;
62 PARA_DEBUG_LOG("header_len: %d\n", header_len);
63 return header_len;
64 }
65
66 /**
67 * \return Negative on errors, zero if more data is needed in order to read the
68 * full header. Positive header length on success.
69 */
70 int read_asf_header(char *buf, int loaded, struct asf_header_info *ahi)
71 {
72 int ret;
73 char *start;
74
75 ahi->header_len = read_header_len(buf, loaded);
76 if (ahi->header_len == 0) /* too short to read header len */
77 return 0;
78 if (ahi->header_len > loaded) /* too short to read header */
79 return 0;
80 ret = find_audio_stream_info(buf, ahi->header_len);
81 if (ret < 0)
82 return ret;
83 ahi->audio_stream_info_start = ret + 16;
84 start = buf + ahi->audio_stream_info_start;
85
86 ahi->channels = ((uint8_t *)start)[40];
87 ahi->sample_rate = read_u16(start + 42);
88 PARA_NOTICE_LOG("%d channels, sample rate: %d\n", ahi->channels,
89 ahi->sample_rate);
90
91 ahi->bit_rate = 8 * read_u16(start + 46);
92 PARA_INFO_LOG("bit rate: %d\n", ahi->bit_rate);
93
94 ahi->block_align = read_u16(start + 50);
95 PARA_INFO_LOG("block_align: %d\n", ahi->block_align);
96
97 ahi->flags1 = read_u32(start + 56);
98 ahi->flags2 = read_u16(start + 60);
99 PARA_INFO_LOG("read_asf_header: flags1: %d, flag2: %d\n",
100 ahi->flags1, ahi->flags2);
101 return 1;
102 }
103
104 const uint8_t log2_tab[256] = {
105 0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 3, 3, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4,
106 4, 4, 4, 4, 4, 4, 4, 4,
107 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5,
108 5, 5, 5, 5, 5, 5, 5, 5,
109 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
110 6, 6, 6, 6, 6, 6, 6, 6,
111 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
112 6, 6, 6, 6, 6, 6, 6, 6,
113 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
114 7, 7, 7, 7, 7, 7, 7, 7,
115 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
116 7, 7, 7, 7, 7, 7, 7, 7,
117 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
118 7, 7, 7, 7, 7, 7, 7, 7,
119 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7, 7,
120 7, 7, 7, 7, 7, 7, 7, 7
121 };
122
123 int wma_log2(unsigned int v)
124 {
125 int n = 0;
126 if (v & 0xffff0000) {
127 v >>= 16;
128 n += 16;
129 }
130 if (v & 0xff00) {
131 v >>= 8;
132 n += 8;
133 }
134 n += log2_tab[v];
135
136 return n;
137 }