/* 
 * File:   ble_hci.c
 * Author: Red Bear Labs
 * modified by Brandon and Nick
 * Comments: Sends passed values out to UART to interface with HCI Bluetooth LE chip
 * 
 * Revision history: Last Updated 12/13/15
 *                  Changed to C file and updated dependecies
 *                  Code originally written for Arduinio, modified all code to 
 *                      be able to write out using PIC32 and protothreads
 */


//#define _ALLOW_KEYWORD_MACROS
#include "typedef.h"
#include "ble_hci.h"
#include <stdio.h>
#include <string.h>
#include <plib.h>

#if defined(__AVR_ATmega328P__)
  #include <AltSoftSerial.h>
  AltSoftSerial *TX;
  uint8 ble_hci_init(AltSoftSerial *ser)
  {
    TX = ser;
  }
#else
  uint8 ble_hci_init()
  {
  }
#endif

bStatus_t GAP_DeviceInit( uint8 taskID, uint8 profileRole, uint8 maxScanResponses, uint8 *pIRK, uint8 *pSRK, uint32 *pSignCounter )
{
  uint8 buf[42];
  uint8 len = 0;
    
  buf[len++] = 0x01;                  // -Type    : 0x01 (Command)
  buf[len++] = 0x00;                  // -Opcode  : 0xFE00 (GAP_DeviceInit)
  buf[len++] = 0xFE;
  
  buf[len++] = 0x26;                  // -Data Length
  buf[len++] = profileRole;           //  Profile Role
  buf[len++] = maxScanResponses;      //  MaxScanRsps
  memcpy(&buf[len], pIRK, 16);        //  IRK
  len += 16;
  memcpy(&buf[len], pSRK, 16);        //  SRK
  len += 16;
  memcpy(&buf[len], pSignCounter, 4); //  SignCounter
  len += 4;

#if defined(__AVR_ATmega328P__)
  (*TX).write(buf, len);
#else
  //modified write out function
  uint8 i;
  //for the entire string
  for (i=0; i<len; i++) {
       //use printf to write the character out if it is not a problematic character
      //problematic characters were determined by testing and are problematic because
      //printf will treat the input like a string
      if(buf[i] != 0x0A || buf[i] != 0x0D || buf[i] != 0x7f){
          printf("%c", buf[i]);
      }
      //manually send out the data using UART registers directly if its a problem character
      else{
        while (!UARTTransmitterIsReady(UART2)) {}
        UARTSendDataByte(UART2, buf[i]);
        printf("sent %c i = % i \n", buf[i], i);
      }
  }
#endif

  return 1;
}

bStatus_t GAP_DeviceDiscoveryRequest( gapDevDiscReq_t *pParams )
{
  uint8 buf[20];
  uint8 len = 0;
    
  buf[len++] = 0x01;                  // -Type    : 0x01 (Command)
  buf[len++] = 0x04;                  // -Opcode  : 0xFE04 (GAP_DeviceDiscoveryRequest)
  buf[len++] = 0xFE;
    
  buf[len++] = 0x03;                 // -Data Length
  buf[len++] = pParams->mode;        //  Mode
  buf[len++] = pParams->activeScan;  //  ActiveScan
  buf[len++] = pParams->whiteList;   //  WhiteList
  
//  hci_tl_write(buf, len);
//  hci_tl_wait_for_response();
  
#if defined(__AVR_ATmega328P__)
  (*TX).write(buf, len);
#else
  //modified write out function
  uint8 i;
  //for the entire string
  for (i=0; i<len; i++) {
       //use printf to write the character out if it is not a problematic character
      //problematic characters were determined by testing and are problematic because
      //printf will treat the input like a string
      if(buf[i] != 0x0A || buf[i] != 0x0D || buf[i] != 0x7f){
          printf("%c", buf[i]);
      }
      //manually send out the data using UART registers directly if its a problem character
      else{
        while (!UARTTransmitterIsReady(UART2)) {}
        UARTSendDataByte(UART2, buf[i]);
        printf("sent %c i = % i \n", buf[i], i);
      }
  }
#endif

  return 1;
}

bStatus_t GAP_EstablishLinkReq( gapEstLinkReq_t *pParams )
{
  uint8 buf[20];
  uint8 len = 0;
    
  buf[len++] = 0x01;
  memcpy(&buf[len], "\x09\xFE", 2);
  len += 2;
  
  buf[len++] = 0x03 + B_ADDR_LEN;
  
  buf[len++] = pParams->highDutyCycle;
  buf[len++] = pParams->whiteList;    
  buf[len++] = pParams->addrTypePeer; //0x01;
  memcpy(&buf[len], pParams->peerAddr, B_ADDR_LEN);
  len+=B_ADDR_LEN;

#if defined(__AVR_ATmega328P__)
  (*TX).write(buf, len);
#else
  //modified write out function
  uint8 i;
  //for the entire string
  for (i=0; i<len; i++) {
       //use printf to write the character out if it is not a problematic character
      //problematic characters were determined by testing and are problematic because
      //printf will treat the input like a string
      if(buf[i] != 0x0A || buf[i] != 0x0D || buf[i] != 0x7f){
          printf("%c", buf[i]);
      }
      //manually send out the data using UART registers directly if its a problem character
      else{
        while (!UARTTransmitterIsReady(UART2)) {}
        UARTSendDataByte(UART2, buf[i]);
        printf("sent %c i = % i \n", buf[i], i);
      }
  }
#endif

  return 1;
}

bStatus_t GATT_WriteCharValue( uint16 connHandle, attWriteReq_t *pReq, uint8 taskId )
{
  uint8 buf[20];
  uint8 len = 0;
  
  buf[len++] = 0x01;
  memcpy(&buf[len], "\x92\xFD", 2);
  len += 2;
  
  buf[len++] = 0x04 + pReq->len;
  
  memcpy(&buf[len], &connHandle, 2);
  len += 2;
  memcpy(&buf[len], &pReq->handle, 2);
  len += 2;
  memcpy(&buf[len], pReq->value, pReq->len);
  len += pReq->len;
  
#if defined(__AVR_ATmega328P__)
  (*TX).write(buf, len);
#else
  //modified write out function
  uint8 i;
  //for the entire string
  for (i=0; i<len; i++) {
       //use printf to write the character out if it is not a problematic character
      //problematic characters were determined by testing and are problematic because
      //printf will treat the input like a string
      if(buf[i] != 0x0A || buf[i] != 0x0D || buf[i] != 0x7f){
          printf("%c", buf[i]);
      }
      //manually send out the data using UART registers directly if its a problem character
      else{
        while (!UARTTransmitterIsReady(UART2)) {}
        UARTSendDataByte(UART2, buf[i]);
        printf("sent %c i = % i \n", buf[i], i);
      }
  }
#endif

  return 1;
}

bStatus_t GATT_WriteNoRsp( uint16 connHandle, attWriteReq_t *pReq, uint8 taskId )
{
  uint8 buf[20];
  uint8 len = 0;
  
  buf[len++] = 0x01;
  memcpy(&buf[len], "\xB6\xFD", 2);
  len += 2;
  
  buf[len++] = 0x04 + pReq->len;
  
  memcpy(&buf[len], &connHandle, 2);
  len += 2;
  memcpy(&buf[len], &pReq->handle, 2);
  len += 2;
  memcpy(&buf[len], pReq->value, pReq->len);
  len += pReq->len;
  
#if defined(__AVR_ATmega328P__)
  (*TX).write(buf, len);
#else
  //modified write out function
  uint8 i;
  //for the entire string
  for (i=0; i<len; i++) {
       //use printf to write the character out if it is not a problematic character
      //problematic characters were determined by testing and are problematic because
      //printf will treat the input like a string
      if(buf[i] != 0x0A || buf[i] != 0x0D || buf[i] != 0x7f){
          printf("%c", buf[i]);
      }
      //manually send out the data using UART registers directly if its a problem character
      else{
        while (!UARTTransmitterIsReady(UART2)) {}
        UARTSendDataByte(UART2, buf[i]);
        printf("sent %c i = % i \n", buf[i], i);
      }
  }
#endif
  return 1;
}


bStatus_t GAP_TerminateLinkReq( uint8 taskID, uint16 connHandle )
{
    uint8 buf[20];
    uint8 len = 0;

    buf[len++] = 0x01;
    memcpy(&buf[len], "\x0A\xFE", 2);
    len += 2;

    buf[len++] = 0x03;

    memcpy(&buf[len], &connHandle, 2);
    len += 2;
    buf[len++] = 0x13;

#if defined(__AVR_ATmega328P__)
    (*TX).write(buf, len);
#else
  //modified write out function
  uint8 i;
  //for the entire string
  for (i=0; i<len; i++) {
       //use printf to write the character out if it is not a problematic character
      //problematic characters were determined by testing and are problematic because
      //printf will treat the input like a string
      if(buf[i] != 0x0A || buf[i] != 0x0D || buf[i] != 0x7f){
          printf("%c", buf[i]);
      }
      //manually send out the data using UART registers directly if its a problem character
      else{
        while (!UARTTransmitterIsReady(UART2)) {}
        UARTSendDataByte(UART2, buf[i]);
        printf("sent %c i = % i \n", buf[i], i);
      }
  }
#endif

    return 1;
}