I bet you didn't try if the fix worked, BBB ;)
[platform/upstream/gst-plugins-good.git] / gst / law / alaw-encode.c
1 /* GStreamer
2  * Copyright (C) 1999 Erik Walthinsen <omega@cse.ogi.edu>
3  * PCM - A-Law conversion
4  *   Copyright (C) 2000 by Abramo Bagnara <abramo@alsa-project.org>
5  *
6  * This library is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Library General Public
8  * License as published by the Free Software Foundation; either
9  * version 2.1 of the License, or (at your option) any later version.
10  *
11  * This library is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Library General Public License for more details.
15  *
16  * You should have received a copy of the GNU Library General Public
17  * License along with this library; if not, write to the
18  * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
19  * Boston, MA 02111-1307, USA.
20  */
21
22 #include <gst/gst.h>
23 #include "alaw-encode.h"
24
25 extern GstPadTemplate *alawenc_src_template, *alawenc_sink_template;
26
27
28 /* Stereo signals and args */
29 enum {
30   /* FILL ME */
31   LAST_SIGNAL
32 };
33
34 enum {
35   ARG_0
36 };
37
38 static void             gst_alawenc_class_init          (GstALawEncClass *klass);
39 static void             gst_alawenc_init                        (GstALawEnc *alawenc);
40
41 static void             gst_alawenc_set_property                        (GObject *object, guint prop_id, const GValue *value, GParamSpec *pspec);
42 static void             gst_alawenc_get_property                        (GObject *object, guint prop_id, GValue *value, GParamSpec *pspec);
43
44 static void             gst_alawenc_chain                       (GstPad *pad, GstBuffer *buf);
45
46 /*
47  * s16_to_alaw() - Convert a 16-bit linear PCM value to 8-bit A-law
48  *
49  * s16_to_alaw() accepts an 16-bit integer and encodes it as A-law data.
50  *
51  *              Linear Input Code       Compressed Code
52  *      ------------------------        ---------------
53  *      0000000wxyza                    000wxyz
54  *      0000001wxyza                    001wxyz
55  *      000001wxyzab                    010wxyz
56  *      00001wxyzabc                    011wxyz
57  *      0001wxyzabcd                    100wxyz
58  *      001wxyzabcde                    101wxyz
59  *      01wxyzabcdef                    110wxyz
60  *      1wxyzabcdefg                    111wxyz
61  *
62  * For further information see John C. Bellamy's Digital Telephony, 1982,
63  * John Wiley & Sons, pps 98-111 and 472-476.
64  */
65
66 static inline gint val_seg(gint val)
67 {
68         gint r = 1;
69         val >>= 8;
70         if (val & 0xf0) {
71                 val >>= 4;
72                 r += 4;
73         }
74         if (val & 0x0c) {
75                 val >>= 2;
76                 r += 2;
77         }
78         if (val & 0x02)
79                 r += 1;
80         return r;
81 }
82
83 static guint8 s16_to_alaw(gint pcm_val)
84 {
85         gint            seg;
86         guint8  mask;
87         guint8  aval;
88
89         if (pcm_val >= 0) {
90                 mask = 0xD5;
91         } else {
92                 mask = 0x55;
93                 pcm_val = -pcm_val;
94                 if (pcm_val > 0x7fff)
95                         pcm_val = 0x7fff;
96         }
97
98         if (pcm_val < 256)
99                 aval = pcm_val >> 4;
100         else {
101                 /* Convert the scaled magnitude to segment number. */
102                 seg = val_seg(pcm_val);
103                 aval = (seg << 4) | ((pcm_val >> (seg + 3)) & 0x0f);
104         }
105         return aval ^ mask;
106 }
107
108 static GstElementClass *parent_class = NULL;
109 /*static guint gst_stereo_signals[LAST_SIGNAL] = { 0 }; */
110
111 static GstPadLinkReturn
112 alawenc_link (GstPad *pad, GstCaps *caps)
113 {
114   GstCaps* tempcaps;
115   gint rate, channels;
116   
117   GstALawEnc* alawenc = GST_ALAWENC (GST_OBJECT_PARENT (pad));
118   
119   if (!GST_CAPS_IS_FIXED (caps))
120     return GST_PAD_LINK_DELAYED;  
121   
122   if (!gst_caps_get (caps, "rate", &rate,
123                            "channels", &channels,
124                            NULL))
125     return GST_PAD_LINK_DELAYED;
126   
127   tempcaps = GST_CAPS_NEW (
128               "alawenc_src_caps",
129               "audio/raw",
130           "format",   GST_PROPS_STRING ("int"),
131           "law",      GST_PROPS_INT (2),
132           "depth",    GST_PROPS_INT (8),
133           "width",    GST_PROPS_INT (8),
134           "signed",   GST_PROPS_BOOLEAN (FALSE),
135           "rate",     GST_PROPS_INT (rate),
136           "channels", GST_PROPS_INT (channels),
137         NULL);
138   
139   return gst_pad_try_set_caps (alawenc->srcpad, tempcaps);
140 }               
141
142 GType
143 gst_alawenc_get_type(void) {
144   static GType alawenc_type = 0;
145
146   if (!alawenc_type) {
147     static const GTypeInfo alawenc_info = {
148       sizeof(GstALawEncClass),      NULL,
149       NULL,
150       (GClassInitFunc)gst_alawenc_class_init,
151       NULL,
152       NULL,
153       sizeof(GstALawEnc),
154       0,
155       (GInstanceInitFunc)gst_alawenc_init,
156     };
157     alawenc_type = g_type_register_static(GST_TYPE_ELEMENT, "GstALawEnc", &alawenc_info, 0);
158   }
159   return alawenc_type;
160 }
161
162 static void
163 gst_alawenc_class_init (GstALawEncClass *klass)
164 {
165   GObjectClass *gobject_class;
166   GstElementClass *gstelement_class;
167
168   gobject_class = (GObjectClass*)klass;
169   gstelement_class = (GstElementClass*)klass;
170
171   parent_class = g_type_class_ref(GST_TYPE_ELEMENT);
172
173   gobject_class->set_property = gst_alawenc_set_property;
174   gobject_class->get_property = gst_alawenc_get_property;
175 }
176
177 static void
178 gst_alawenc_init (GstALawEnc *alawenc)
179 {
180   alawenc->sinkpad = gst_pad_new_from_template(alawenc_sink_template,"sink");
181   alawenc->srcpad = gst_pad_new_from_template(alawenc_src_template,"src");
182   gst_pad_set_link_function (alawenc->sinkpad, alawenc_link);
183
184   gst_element_add_pad(GST_ELEMENT(alawenc),alawenc->sinkpad);
185   gst_pad_set_chain_function(alawenc->sinkpad,gst_alawenc_chain);
186   gst_element_add_pad(GST_ELEMENT(alawenc),alawenc->srcpad);
187 }
188
189 static void
190 gst_alawenc_chain (GstPad *pad,GstBuffer *buf)
191 {
192   GstALawEnc *alawenc;
193   gint16 *linear_data;
194   guint8 *alaw_data;
195   GstBuffer* outbuf;
196   gint i;
197
198   g_return_if_fail(pad != NULL);
199   g_return_if_fail(GST_IS_PAD(pad));
200   g_return_if_fail(buf != NULL);
201
202   alawenc = GST_ALAWENC(GST_OBJECT_PARENT (pad));
203   g_return_if_fail(alawenc != NULL);
204   g_return_if_fail(GST_IS_ALAWENC(alawenc));
205
206   linear_data = (gint16 *)GST_BUFFER_DATA(buf);
207   outbuf=gst_buffer_new();
208   GST_BUFFER_DATA(outbuf) = (gchar*)g_new(guint8,GST_BUFFER_SIZE(buf)/2);
209   GST_BUFFER_SIZE(outbuf) = GST_BUFFER_SIZE(buf)/2;
210
211   
212   alaw_data = (guint8*)GST_BUFFER_DATA(outbuf);
213   for (i = 0; i < GST_BUFFER_SIZE(outbuf); i++) {
214     *alaw_data = s16_to_alaw (*linear_data);
215     alaw_data++;
216     linear_data++;
217   }
218   gst_buffer_unref(buf);
219   gst_pad_push(alawenc->srcpad,outbuf);
220 }
221
222 static void
223 gst_alawenc_set_property (GObject *object, guint prop_id, const GValue *value, GParamSpec *pspec)
224 {
225   GstALawEnc *alawenc;
226
227   /* it's not null if we got it, but it might not be ours */
228   g_return_if_fail(GST_IS_ALAWENC(object));
229   alawenc = GST_ALAWENC(object);
230
231   switch (prop_id) {
232     default:
233       break;
234   }
235 }
236
237 static void
238 gst_alawenc_get_property (GObject *object, guint prop_id, GValue *value, GParamSpec *pspec)
239 {
240   GstALawEnc *alawenc;
241
242   /* it's not null if we got it, but it might not be ours */
243   g_return_if_fail(GST_IS_ALAWENC(object));
244   alawenc = GST_ALAWENC(object);
245
246   switch (prop_id) {
247     default:
248       G_OBJECT_WARN_INVALID_PROPERTY_ID (object, prop_id, pspec);
249       break;
250   }
251 }