source: roaraudio/libroar/caps.c @ 6029:c25f9d9f78a6

//caps.c:

/*
 *      Copyright (C) Philipp 'ph3-der-loewe' Schafft - 2010-2014
 *
 *  This file is part of libroar a part of RoarAudio,
 *  a cross-platform sound system for both, home and professional use.
 *  See README for details.
 *
 *  This file is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 3
 *  as published by the Free Software Foundation.
 *
 *  libroar 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 General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this software; see the file COPYING.  If not, write to
 *  the Free Software Foundation, 51 Franklin Street, Fifth Floor,
 *  Boston, MA 02110-1301, USA.
 *
 *  NOTE for everyone want's to change something and send patches:
 *  read README and HACKING! There a addition information on
 *  the license of this document you need to read before you send
 *  any patches.
 *
 *  NOTE for uses of non-GPL (LGPL,...) software using libesd, libartsc
 *  or libpulse*:
 *  The libs libroaresd, libroararts and libroarpulse link this lib
 *  and are therefore GPL. Because of this it may be illigal to use
 *  them with any software that uses libesd, libartsc or libpulse*.
 */

#include "libroar.h"

const struct roar_stds * libroar_libstds(void) {
 static const uint32_t std[] = {
  ROAR_STD_MAKE(ROAR_STDV_ROARAUDIO, 0, 0)  // ra-msg-v0
 };
 static const struct roar_stds stds = {.stds_len = sizeof(std)/sizeof(*std), .stds = (uint32_t*)std};
 return &stds;
}

int roar_caps_to_msg(struct roar_message * mes,  struct roar_caps    * caps, void ** data) {
 char * datap;
 size_t needlen = 4;

 if ( mes == NULL || caps == NULL ) {
  roar_err_set(ROAR_ERROR_FAULT);
  return -1;
 }

 needlen += caps->len;

 if ( needlen > sizeof(mes->data) ) {
  if ( data == NULL ) {
   roar_err_set(ROAR_ERROR_FAULT);
   return -1;
  }

  if ( (*data = roar_mm_malloc(needlen)) == NULL )
   return -1;

  datap = *data;
 } else {
  datap = mes->data;
 }

 datap[0] = caps->version;
 datap[1] = caps->type;
 datap[2] = (caps->flags & 0xFF00) >> 8;
 datap[3] = caps->flags & 0xFF;

 if ( caps->len != 0 ) {
  memcpy(&(datap[4]), caps->data, caps->len);
 }

 mes->datalen = needlen;

 return 0;
}

int roar_caps_from_msg(struct roar_caps  * caps, struct roar_message * mes,  void  * data) {
 char * datap;

 if ( mes == NULL || caps == NULL ) {
  roar_err_set(ROAR_ERROR_FAULT);
  return -1;
 }

 if ( data != NULL ) {
  datap = data;
 } else {
  datap = mes->data;
 }

 // versin check.
 if ( datap[0] != 0 ) {
  roar_err_set(ROAR_ERROR_NSVERSION);
  return -1;
 }

 if ( mes->datalen < 4 ) {
  roar_err_set(ROAR_ERROR_PROTO);
  return -1;
 }

 memset(caps, 0, sizeof(struct roar_caps));

 caps->version = datap[0];
 caps->type    = datap[1];
 caps->flags   = (datap[2] << 8) | datap[3];

 if ( mes->datalen == 4 ) {
  caps->data    = NULL;
  caps->len     = 0;
 } else {
  caps->data    = &(datap[4]);
  caps->len     = mes->datalen - 4;
 }

 return 0;
}

int roar_caps_stds(struct roar_connection * con, struct roar_stds ** out, struct roar_stds * in, int flags) {
 struct roar_message mes;
 struct roar_caps caps;
 void * data = NULL;
 char * data_char;
 size_t i;

 ROAR_DBG("roar_caps_stds(con=%p, out=%p, in=%p, flags=0x%.4x) = ?", con, out, in, flags);

 if ( flags == -1 )
  flags = 0;

 if ( con == NULL ) {
  roar_err_set(ROAR_ERROR_FAULT);
  return -1;
 }

 if ( out != NULL )
  flags |= ROAR_CF_REQUEST;

 if ( (flags & ROAR_CF_REQUEST) && out == NULL ) {
  roar_err_set(ROAR_ERROR_FAULT);
  return -1;
 }

 if ( in != NULL )
  if ( in->stds_len == 0 )
   in = NULL;

 memset(&caps, 0, sizeof(caps));

 caps.version = 0;
 caps.type    = ROAR_CT_STANDARDS;
 caps.flags   = flags;

 memset(&mes, 0, sizeof(mes));

 if ( in != NULL ) {
  // we use a hack here to avoid double alloc:
  // first pass the data in native byte order.
  // after we got a buffer swap in-buffer.
  caps.data = in->stds;
  caps.len  = in->stds_len * 4;
 }

 if ( roar_caps_to_msg(&mes, &caps, &data) == -1 )
  return -1;

 if ( in != NULL ) {
  if ( data == NULL ) {
   for (i = 0; i < in->stds_len; i++) {
    ((uint32_t*)mes.data)[i] = ROAR_HOST2NET32(((uint32_t*)mes.data)[i]);
   }
  } else {
   for (i = 0; i < in->stds_len; i++) {
    ((uint32_t*)data)[i] = ROAR_HOST2NET32(((uint32_t*)data)[i]);
   }
  }
 }

 mes.cmd = ROAR_CMD_CAPS;

 data_char = data;
 if ( roar_req(con, &mes, &data_char) == -1 )
  return -1;
 data = data_char;

 if ( mes.cmd != ROAR_CMD_OK ) {
  if ( data != NULL )
   roar_mm_free_noerror(data);
  return -1;
 }

 if ( roar_caps_from_msg(&caps, &mes, data) == -1 ) {
  if ( data != NULL )
   roar_mm_free_noerror(data);
  return -1;
 }

 // check if response matches the request:
 if ( caps.version != 0 || caps.type != ROAR_CT_STANDARDS || (caps.len & 0x3) != 0 ) {
  if ( data != NULL )
   roar_mm_free(data);
  roar_err_set(ROAR_ERROR_PROTO);
  return -1;
 }

 if ( out != NULL ) {
  *out = roar_stds_new(caps.len/4);
  if ( *out == NULL ) {
   if ( data != NULL )
    roar_mm_free_noerror(data);
   return -1;
  }

  ROAR_DBG("roar_caps_stds(con=%p, out=%p, in=%p, flags=0x%.4x): (*out)->stds_len=%llu", con, out, in, flags, (long long unsigned int)(*out)->stds_len);

  for (i = 0; i < (*out)->stds_len; i++) {
   (*out)->stds[i] = ROAR_NET2HOST32(((uint32_t*)caps.data)[i]);
   ROAR_DBG("roar_caps_stds(con=%p, out=%p, in=%p, flags=0x%.4x): (*out)->stds[%llu] = 0x%.8x", con, out, in, flags, (long long unsigned int)i, (*out)->stds[i]);
  }
 }

 if ( data != NULL )
  roar_mm_free(data);

 return 0;
}

struct roar_stds * roar_stds_new(size_t len) {
 struct roar_stds * ret;

 if ( len == 0 ) {
  roar_err_set(ROAR_ERROR_INVAL);
  return NULL;
 }

 ret = roar_mm_malloc(sizeof(struct roar_stds));

 if ( ret == NULL )
  return NULL;

 memset(ret, 0, sizeof(struct roar_stds));

 ret->stds_len = len;
 ret->stds     = roar_mm_malloc(len*sizeof(uint32_t));

 if ( ret->stds == NULL ) {
  roar_mm_free_noerror(ret);
  return NULL;
 }

 memset(ret->stds, 0, len*sizeof(uint32_t));

 return ret;
}

int roar_stds_free(struct roar_stds * stds) {
 if ( stds == NULL ) {
  roar_err_set(ROAR_ERROR_FAULT);
  return -1;
 }

 if ( stds->stds != NULL )
  roar_mm_free(stds->stds);

 roar_mm_free(stds);

 return 0;
}


static struct {
 const int    vendor;
 const char * name;
} _libroar_std_vendors[] = {
 {ROAR_STDV_ROARAUDIO, "RoarAudio"},
 {ROAR_STDV_PROTO,     "Protocols"},
 {ROAR_STDV_RFC,       "RFC"},
 {-1, NULL}
};

int roar_stds_str2vendor(const char * vendor) {
 int i;

 if ( vendor == NULL ) {
  roar_err_set(ROAR_ERROR_FAULT);
  return -1;
 }

 for (i = 0; _libroar_std_vendors[i].name != NULL; i++)
  if ( !strcasecmp(_libroar_std_vendors[i].name, vendor) )
   return _libroar_std_vendors[i].vendor;

 roar_err_set(ROAR_ERROR_NOENT);
 return -1;
}

const char * roar_stds_vendor2str(const int vendor) {
 int i;

 for (i = 0; _libroar_std_vendors[i].name != NULL; i++)
  if ( _libroar_std_vendors[i].vendor == vendor )
   return _libroar_std_vendors[i].name;

 roar_err_set(ROAR_ERROR_NOENT);
 return NULL;
}


//ll