summaryrefslogtreecommitdiff
path: root/src/rtp_profile_l16.cc
blob: f57ba4bd8c02160786a162c5b1e1c68f2baa70e7 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
/* -*- Mode: C++; tab-width: 2; indent-tabs-mode: nil; c-basic-offset: 2 -*- */
/* vim: set et sw=2 ts=2: */
/***************************************************************************
 *            rtp_profile_l16.cc
 *
 *  Mon Dec 23 14:36:50 CET 2013
 *  Copyright 2013 Bent Bisballe Nyeng
 *  deva@aasimon.org
 ****************************************************************************/

/*
 *  This file is part of lrtp.
 *
 * lrtp is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * lrtp 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
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with lrtp; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
 */
#include "rtp_profile_l16.h"

#include "rtp_profile.h"

#include <stdio.h>
#include <string.h>

// For ntoh et al.
#ifdef WIN32
#include <winsock2.h>
#else
#include <arpa/inet.h>
#endif

struct lrtp_profile_l16_t {
  struct lrtp_profile_t profile; // 'Inherit' lrtp_profile_t

  unsigned short int pkg_size;
  unsigned int num_channels;
  bool little_endian;
};

int profile_l16_pack(struct lrtp_profile_t *profile,
                     const char *frame, size_t framesize,
                     RTP &rtp)
{
  struct lrtp_profile_l16_t *p = (struct lrtp_profile_l16_t *)profile;

  size_t cpsamples = p->pkg_size;

  // Calculate complete sample-channel tuples in frame.
  size_t num_samples = framesize / (sizeof(short) * p->num_channels);

  if(cpsamples > num_samples) cpsamples = num_samples;

  // Convert to bytes
  size_t cpsz = cpsamples * sizeof(short) * p->num_channels;

  if(p->little_endian) {
    short *buf = (short*)malloc(cpsz / sizeof(short));
    for(size_t i = 0; i < cpsz / sizeof(short); i++) {
      buf[i] = htons(((const short*)frame)[i]);
    }
    rtp.setPayload((char*)buf, cpsz);
    free(buf);
  } else {
    rtp.setPayload(frame, cpsz);
  }

  return cpsz;
}

int profile_l16_unpack(struct lrtp_profile_t *profile,
                       const RTP &rtp,
                       oframelist_t &framelist)
{
  struct lrtp_profile_l16_t *p = (struct lrtp_profile_l16_t *)profile;

  outputframe_t *of = new outputframe_t();
  of->size = rtp.payloadSize();
  char *buf = (char*)malloc(of->size);

  if(p->little_endian) {
    const short *frame = (const short *)rtp.payloadData();
    for(size_t i = 0; i < of->size / sizeof(short); i++) {
      ((short*)buf)[i] = ntohs(frame[i]);
    }
  } else {
    of->size = rtp.payload(buf, of->size);
  }

  of->data = buf;

  framelist.push_back(of);

  return 0;
}

void profile_l16_destroy(struct lrtp_profile_t *profile)
{
  struct lrtp_profile_l16_t *p = (struct lrtp_profile_l16_t *)profile;
  delete p;
}

struct lrtp_profile_t *profile_l16_create(struct lrtp_t *lrtp,
                                          unsigned int csrc,
                                          va_list vp)
{
  struct lrtp_profile_l16_t *p = new struct lrtp_profile_l16_t;

  p->profile.pack = profile_l16_pack;
  p->profile.unpack = profile_l16_unpack;
  p->profile.destroy = profile_l16_destroy;

  p->pkg_size = 1024;
  p->little_endian = false;
  p->num_channels = 1;
  
  while(true) {
    int type = va_arg(vp, int);
    if(type == OPTION_END) break;

    switch(type) {
    case OPTION_L16_SAMPLES_PER_CHANNEL_PER_PACKET:
      p->pkg_size = va_arg(vp, int);
      break;
    case OPTION_L16_CHANNELS:
      p->num_channels = va_arg(vp, int);
      break;
    case OPTION_L16_LITTLE_ENDIAN:
      p->little_endian = va_arg(vp, int);
      break;
    default:
      // TODO: Unknown arg type
      break;
    }
  }

  return &p->profile;
}