gstrtpceltdepay.c 8.03 KB
Newer Older
Wim Taymans's avatar
Wim Taymans committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/* GStreamer
 * Copyright (C) <2009> Wim Taymans <wim.taymans@gmail.com>
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Library General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Library General Public License for more details.
 *
 * You should have received a copy of the GNU Library General Public
 * License along with this library; if not, write to the
Tim-Philipp Müller's avatar
Tim-Philipp Müller committed
16 17
 * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
 * Boston, MA 02110-1301, USA.
Wim Taymans's avatar
Wim Taymans committed
18 19 20 21 22 23 24 25 26 27 28 29
 */

#ifdef HAVE_CONFIG_H
#  include "config.h"
#endif

#include <string.h>
#include <stdlib.h>
#include <gst/rtp/gstrtpbuffer.h>

#include "gstrtpceltdepay.h"

30 31 32
GST_DEBUG_CATEGORY_STATIC (rtpceltdepay_debug);
#define GST_CAT_DEFAULT (rtpceltdepay_debug)

Wim Taymans's avatar
Wim Taymans committed
33
/* RtpCELTDepay signals and args */
34 35 36 37 38

#define DEFAULT_FRAMESIZE       480
#define DEFAULT_CHANNELS        1
#define DEFAULT_CLOCKRATE       32000

Wim Taymans's avatar
Wim Taymans committed
39 40 41 42 43 44 45 46
enum
{
  /* FILL ME */
  LAST_SIGNAL
};

enum
{
47
  PROP_0
Wim Taymans's avatar
Wim Taymans committed
48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66
};

static GstStaticPadTemplate gst_rtp_celt_depay_sink_template =
GST_STATIC_PAD_TEMPLATE ("sink",
    GST_PAD_SINK,
    GST_PAD_ALWAYS,
    GST_STATIC_CAPS ("application/x-rtp, "
        "media = (string) \"audio\", "
        "clock-rate =  (int) [32000, 48000], "
        "encoding-name = (string) \"CELT\"")
    );

static GstStaticPadTemplate gst_rtp_celt_depay_src_template =
GST_STATIC_PAD_TEMPLATE ("src",
    GST_PAD_SRC,
    GST_PAD_ALWAYS,
    GST_STATIC_CAPS ("audio/x-celt")
    );

Wim Taymans's avatar
Wim Taymans committed
67
static GstBuffer *gst_rtp_celt_depay_process (GstRTPBaseDepayload * depayload,
68
    GstRTPBuffer * rtp);
Wim Taymans's avatar
Wim Taymans committed
69
static gboolean gst_rtp_celt_depay_setcaps (GstRTPBaseDepayload * depayload,
Wim Taymans's avatar
Wim Taymans committed
70 71
    GstCaps * caps);

72 73
#define gst_rtp_celt_depay_parent_class parent_class
G_DEFINE_TYPE (GstRtpCELTDepay, gst_rtp_celt_depay,
Wim Taymans's avatar
Wim Taymans committed
74
    GST_TYPE_RTP_BASE_DEPAYLOAD);
Wim Taymans's avatar
Wim Taymans committed
75 76

static void
77
gst_rtp_celt_depay_class_init (GstRtpCELTDepayClass * klass)
Wim Taymans's avatar
Wim Taymans committed
78
{
79
  GstElementClass *gstelement_class;
Wim Taymans's avatar
Wim Taymans committed
80
  GstRTPBaseDepayloadClass *gstrtpbasedepayload_class;
81 82 83

  GST_DEBUG_CATEGORY_INIT (rtpceltdepay_debug, "rtpceltdepay", 0,
      "CELT RTP Depayloader");
Wim Taymans's avatar
Wim Taymans committed
84

85
  gstelement_class = (GstElementClass *) klass;
Wim Taymans's avatar
Wim Taymans committed
86
  gstrtpbasedepayload_class = (GstRTPBaseDepayloadClass *) klass;
Wim Taymans's avatar
Wim Taymans committed
87

88 89 90 91 92
  gst_element_class_add_pad_template (gstelement_class,
      gst_static_pad_template_get (&gst_rtp_celt_depay_src_template));
  gst_element_class_add_pad_template (gstelement_class,
      gst_static_pad_template_get (&gst_rtp_celt_depay_sink_template));

93
  gst_element_class_set_static_metadata (gstelement_class,
94 95 96 97
      "RTP CELT depayloader", "Codec/Depayloader/Network/RTP",
      "Extracts CELT audio from RTP packets",
      "Wim Taymans <wim.taymans@gmail.com>");

98
  gstrtpbasedepayload_class->process_rtp_packet = gst_rtp_celt_depay_process;
Wim Taymans's avatar
Wim Taymans committed
99
  gstrtpbasedepayload_class->set_caps = gst_rtp_celt_depay_setcaps;
Wim Taymans's avatar
Wim Taymans committed
100 101 102
}

static void
103
gst_rtp_celt_depay_init (GstRtpCELTDepay * rtpceltdepay)
Wim Taymans's avatar
Wim Taymans committed
104 105 106 107 108 109 110 111 112 113 114
{
}

/* len 4 bytes LE,
 * vendor string (len bytes),
 * user_len 4 (0) bytes LE
 */
static const gchar gst_rtp_celt_comment[] =
    "\045\0\0\0Depayloaded with GStreamer celtdepay\0\0\0\0";

static gboolean
Wim Taymans's avatar
Wim Taymans committed
115
gst_rtp_celt_depay_setcaps (GstRTPBaseDepayload * depayload, GstCaps * caps)
Wim Taymans's avatar
Wim Taymans committed
116 117 118
{
  GstStructure *structure;
  GstRtpCELTDepay *rtpceltdepay;
119
  gint clock_rate, nb_channels = 0, frame_size = 0;
Wim Taymans's avatar
Wim Taymans committed
120
  GstBuffer *buf;
Wim Taymans's avatar
Wim Taymans committed
121 122
  GstMapInfo map;
  guint8 *ptr;
Wim Taymans's avatar
Wim Taymans committed
123 124 125 126 127 128 129 130 131 132 133 134
  const gchar *params;
  GstCaps *srccaps;
  gboolean res;

  rtpceltdepay = GST_RTP_CELT_DEPAY (depayload);

  structure = gst_caps_get_structure (caps, 0);

  if (!gst_structure_get_int (structure, "clock-rate", &clock_rate))
    goto no_clockrate;
  depayload->clock_rate = clock_rate;

135
  if ((params = gst_structure_get_string (structure, "encoding-params")))
Wim Taymans's avatar
Wim Taymans committed
136
    nb_channels = atoi (params);
137 138
  if (!nb_channels)
    nb_channels = DEFAULT_CHANNELS;
Wim Taymans's avatar
Wim Taymans committed
139

140
  if ((params = gst_structure_get_string (structure, "frame-size")))
Wim Taymans's avatar
Wim Taymans committed
141
    frame_size = atoi (params);
142 143 144 145 146 147
  if (!frame_size)
    frame_size = DEFAULT_FRAMESIZE;
  rtpceltdepay->frame_size = frame_size;

  GST_DEBUG_OBJECT (depayload, "clock-rate=%d channels=%d frame-size=%d",
      clock_rate, nb_channels, frame_size);
Wim Taymans's avatar
Wim Taymans committed
148 149 150

  /* construct minimal header and comment packet for the decoder */
  buf = gst_buffer_new_and_alloc (60);
Wim Taymans's avatar
Wim Taymans committed
151 152
  gst_buffer_map (buf, &map, GST_MAP_WRITE);
  ptr = map.data;
Wim Taymans's avatar
Wim Taymans committed
153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171
  memcpy (ptr, "CELT    ", 8);
  ptr += 8;
  memcpy (ptr, "1.1.12", 7);
  ptr += 20;
  GST_WRITE_UINT32_LE (ptr, 0x80000006);        /* version */
  ptr += 4;
  GST_WRITE_UINT32_LE (ptr, 56);        /* header_size */
  ptr += 4;
  GST_WRITE_UINT32_LE (ptr, clock_rate);        /* rate */
  ptr += 4;
  GST_WRITE_UINT32_LE (ptr, nb_channels);       /* channels */
  ptr += 4;
  GST_WRITE_UINT32_LE (ptr, frame_size);        /* frame-size */
  ptr += 4;
  GST_WRITE_UINT32_LE (ptr, -1);        /* overlap */
  ptr += 4;
  GST_WRITE_UINT32_LE (ptr, -1);        /* bytes_per_packet */
  ptr += 4;
  GST_WRITE_UINT32_LE (ptr, 0); /* extra headers */
Wim Taymans's avatar
Wim Taymans committed
172
  gst_buffer_unmap (buf, &map);
Wim Taymans's avatar
Wim Taymans committed
173

174
  srccaps = gst_caps_new_empty_simple ("audio/x-celt");
Wim Taymans's avatar
Wim Taymans committed
175 176 177
  res = gst_pad_set_caps (depayload->srcpad, srccaps);
  gst_caps_unref (srccaps);

Wim Taymans's avatar
Wim Taymans committed
178
  gst_rtp_base_depayload_push (GST_RTP_BASE_DEPAYLOAD (rtpceltdepay), buf);
Wim Taymans's avatar
Wim Taymans committed
179 180

  buf = gst_buffer_new_and_alloc (sizeof (gst_rtp_celt_comment));
Wim Taymans's avatar
Wim Taymans committed
181
  gst_buffer_fill (buf, 0, gst_rtp_celt_comment, sizeof (gst_rtp_celt_comment));
Wim Taymans's avatar
Wim Taymans committed
182

Wim Taymans's avatar
Wim Taymans committed
183
  gst_rtp_base_depayload_push (GST_RTP_BASE_DEPAYLOAD (rtpceltdepay), buf);
Wim Taymans's avatar
Wim Taymans committed
184 185 186 187 188 189

  return res;

  /* ERRORS */
no_clockrate:
  {
190
    GST_ERROR_OBJECT (depayload, "no clock-rate specified");
Wim Taymans's avatar
Wim Taymans committed
191 192 193 194 195
    return FALSE;
  }
}

static GstBuffer *
196
gst_rtp_celt_depay_process (GstRTPBaseDepayload * depayload, GstRTPBuffer * rtp)
Wim Taymans's avatar
Wim Taymans committed
197 198 199 200 201
{
  GstBuffer *outbuf = NULL;
  guint8 *payload;
  guint offset, pos, payload_len, total_size, size;
  guint8 s;
202 203 204 205 206 207 208 209 210
  gint clock_rate = 0, frame_size = 0;
  GstClockTime framesize_ns = 0, timestamp;
  guint n = 0;
  GstRtpCELTDepay *rtpceltdepay;

  rtpceltdepay = GST_RTP_CELT_DEPAY (depayload);
  clock_rate = depayload->clock_rate;
  frame_size = rtpceltdepay->frame_size;
  framesize_ns = gst_util_uint64_scale_int (frame_size, GST_SECOND, clock_rate);
Wim Taymans's avatar
Wim Taymans committed
211

212
  timestamp = GST_BUFFER_PTS (rtp->buffer);
Wim Taymans's avatar
Wim Taymans committed
213

214 215
  GST_LOG_OBJECT (depayload,
      "got %" G_GSIZE_FORMAT " bytes, mark %d ts %u seqn %d",
216 217
      gst_buffer_get_size (rtp->buffer), gst_rtp_buffer_get_marker (rtp),
      gst_rtp_buffer_get_timestamp (rtp), gst_rtp_buffer_get_seq (rtp));
Wim Taymans's avatar
Wim Taymans committed
218

219 220 221 222
  GST_LOG_OBJECT (depayload, "got clock-rate=%d, frame_size=%d, "
      "_ns=%" GST_TIME_FORMAT ", timestamp=%" GST_TIME_FORMAT, clock_rate,
      frame_size, GST_TIME_ARGS (framesize_ns), GST_TIME_ARGS (timestamp));

223 224
  payload = gst_rtp_buffer_get_payload (rtp);
  payload_len = gst_rtp_buffer_get_payload_len (rtp);
Wim Taymans's avatar
Wim Taymans committed
225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240

  /* first count how many bytes are consumed by the size headers and make offset
   * point to the first data byte */
  total_size = 0;
  offset = 0;
  while (total_size < payload_len) {
    do {
      s = payload[offset++];
      total_size += s + 1;
    } while (s == 0xff);
  }

  /* offset is now pointing to the payload */
  total_size = 0;
  pos = 0;
  while (total_size < payload_len) {
241
    n++;
Wim Taymans's avatar
Wim Taymans committed
242 243 244 245
    size = 0;
    do {
      s = payload[pos++];
      size += s;
246
      total_size += s + 1;
Wim Taymans's avatar
Wim Taymans committed
247 248
    } while (s == 0xff);

249
    outbuf = gst_rtp_buffer_get_payload_subbuffer (rtp, offset, size);
Wim Taymans's avatar
Wim Taymans committed
250 251
    offset += size;

252
    if (frame_size != -1 && clock_rate != -1) {
253
      GST_BUFFER_PTS (outbuf) = timestamp + framesize_ns * n;
254 255 256 257
      GST_BUFFER_DURATION (outbuf) = framesize_ns;
    }
    GST_LOG_OBJECT (depayload, "push timestamp=%"
        GST_TIME_FORMAT ", duration=%" GST_TIME_FORMAT,
258
        GST_TIME_ARGS (GST_BUFFER_PTS (outbuf)),
259 260
        GST_TIME_ARGS (GST_BUFFER_DURATION (outbuf)));

Wim Taymans's avatar
Wim Taymans committed
261
    gst_rtp_base_depayload_push (depayload, outbuf);
Wim Taymans's avatar
Wim Taymans committed
262
  }
Wim Taymans's avatar
Wim Taymans committed
263

Wim Taymans's avatar
Wim Taymans committed
264 265 266 267 268 269 270
  return NULL;
}

gboolean
gst_rtp_celt_depay_plugin_init (GstPlugin * plugin)
{
  return gst_element_register (plugin, "rtpceltdepay",
271
      GST_RANK_SECONDARY, GST_TYPE_RTP_CELT_DEPAY);
Wim Taymans's avatar
Wim Taymans committed
272
}