/*
 * Licensed to Open Source Radio Access Network(OS-RAN) Alliance and OAI
 * Software Alliance under one or more contributor license agreements. The
 * initial OpenXG series projects are derided from OAI projects, the files from
 * OAI projects are all in compliance with OAI Public License, Version 1.1.
 * codes and files developed from OpenXG projects and from OS-RAN Alliance
 * are all under OS-RAN licenses; you may not use this file except in compliance
 * with the license.  You may get a copy of the license at:
 *	http://www.openxg.org.cn/?falu_69.html
 * For more information about OpenXG, please contact:
 * contact@openxg.org.cn
 */

#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>

#include "TLVEncoder.h"
#include "TLVDecoder.h"
#include "SSCMode.h"

int encode_ssc_mode(
    SSCMode sscmode, uint8_t iei, uint8_t* buffer, uint32_t len) {
  uint32_t encoded  = 0;
  uint8_t bitStream = 0x00;
  CHECK_PDU_POINTER_AND_LENGTH_ENCODER(buffer, SSC_MODE_MINIMUM_LENGTH, len);

  if (iei > 0) {
    bitStream |= (iei & 0xf0);
  }

  bitStream |= (sscmode.ssc_mode_value & 0x07);
  ENCODE_U8(buffer + encoded, bitStream, encoded);

  return encoded;
}

int decode_ssc_mode(
    SSCMode* sscmode, uint8_t iei, uint8_t* buffer, uint32_t len) {
  int decoded       = 0;
  uint8_t bitStream = 0x00;

  DECODE_U8(buffer + decoded, bitStream, decoded);

  if (iei != (bitStream & 0xf0)) {
    return -1;
  }

  if (iei > 0) {
    bitStream = (bitStream & 0x07);
  }

  sscmode->ssc_mode_value = bitStream;

  return decoded;
}
