esp32_bluetooth.c

#include "main-header.h"
#include "espressif/esp8266_flash.h"
#include "shifter.h"
#include "espressif/esp32_bluetooth.h"
static struct bt_peer_info peer_info;
static struct shifter shifty;
static struct command *bt_get_reply() {
  struct command *dcom = get_data_reply(peer_info.bt_peer_com);
 
  if (dcom == NULL) {
    peer_info.valid = 0;
    return NULL;
  }
  dcom->recipient = peer_info.bt_peer_com->target;
  dcom->flags = COMFLAGS_DATA | COMFLAGS_SUCCESS;
  return dcom;
}
static void bt_peer_update_finished(const uint8_t *buf, int size) {
  int sent_peers = buf[6];
 
  printf("[bt-peer-update] final ack for (received %i peers, esp32 sent %i peers)\r\n", peer_info.peercount, sent_peers);
 
  int i;
  struct command *com = NULL;
  int peers_in_com = 0;
 
  for (i = 0; i < MAX_BT_PEERS; i++) {
    struct bt_peer *peer = &peer_info.peers[i];
    if (peer->mac == 0) {
      continue;
    }
 
    if (peers_in_com > 5) {
      deliver_command(com, NULL);
      com = NULL;
      peers_in_com = 0;
    }
 
    if (com == NULL) {
      com = bt_get_reply();
      if (com == NULL) {
        printf("[bt-peer-update] no command allocatable\r\n");
        break;
      }
    }
 
    uint8_t bbuf[100];
    struct shifter *sh = &shifty;
    shifter_init(sh, (uint8_t *)&bbuf, 90);
    shift_into_uint64(sh, peer->mac);
    shift_into_uint8(sh, strlen(peer->name));
    int j;
    for (j = 0; j < strlen(peer->name); j++) {
      shift_into_uint8(sh, peer->name[j]);
    }
    if (shift_error(sh)) {
      printf("[bt-peer-update] Shift error: %i\r\n", shift_error(sh));
      continue;
    }
    peers_in_com++;
    command_add_binary_arg(com, shift_size(sh), (const byte *)bbuf);
  }
  if (com != NULL) {
    deliver_command(com, NULL);
  }
  //last one
  struct command *dcom = get_data_reply(peer_info.bt_peer_com);
 
  if (dcom == NULL) {
    peer_info.valid = 0;
    return;
  }
  dcom->recipient = peer_info.bt_peer_com->target;
  dcom->flags = COMFLAGS_ACK | COMFLAGS_SUCCESS;
  command_add_arg(dcom, "peers=%i", peer_info.peercount);
  command_add_arg(dcom, "btpeers=%i", sent_peers);
  deliver_command(dcom, NULL);
  free_command(peer_info.bt_peer_com);
  peer_info.valid = 0;
  return;
}
static void bt_peer_update_continue(const uint8_t *buf, int size) {
  peer_info.peercount++;
 
  int nc = 0;
  struct bt_peer *peer = NULL;
 
  for (nc = 0; nc < MAX_BT_PEERS; nc++) {
    struct bt_peer *p = &peer_info.peers[nc];
    if (p->mac == 0) {
      peer = p;
      break;
    }
  }
  if (peer == NULL) {
    printf("[bt-peer-update] No more peer spaces\r\n");
    return;
  }
  peer->mac = 0;
  peer->name[0] = 0;
  nc = 0;
  uint32_t seq = 0;
 
  seq |= (((uint32_t)buf[nc++]) << (1 * 24));
  seq |= (((uint32_t)buf[nc++]) << (1 * 16));
  seq |= (((uint32_t)buf[nc++]) << (1 * 8));
  seq |= buf[nc++];
 
  nc++; // idx
  nc++; // follows
  int i;
 
  for (i = 0; i < 6; i++) {
    peer->mac = peer->mac << 8;
    peer->mac = peer->mac | buf[nc++];
  }
  int nl = buf[nc++];
 
  if (nl >= sizeof(peer->name)) {
    nl = sizeof(peer->name) - 1;
  }
  for (i = 0; i < nl; i++) {
    peer->name[i] = buf[nc++];
  }
  peer->name[i] = 0;
  //  printf("[bt-peer-update] sequence: idx=%i,seq=%p,nc=%i,mac=\"%s\",name=\"%s\"\r\n",idx,seq,nc,nbuf,cbuf);
}
 
// received a peer update message
void bt_peer_update(const uint8_t *buf, int size) {
  int idx = buf[4];
  int follows = buf[5];
 
  printf("[bt-peer-update] received (idx=%i,follows=%i):\r\n", idx, follows);
  printHex(" ", buf, size);
  if (peer_info.valid == 0) {
    printf("[bt-peer-update] received, but no trigger command\r\n");
    return;
  }
 
  if (follows == 0) {
    bt_peer_update_finished(buf, size);
  } else {
    bt_peer_update_continue(buf, size);
  }
}
 
 
// request bt peers
int esp32_bt_peers(struct command *com) {
  peer_info.bt_peer_com = get_data_reply(com);
  if (peer_info.bt_peer_com == NULL) {
    return 2;
  }
  peer_info.peercount = 0;
  peer_info.valid = 1;
  int i;
 
  for (i = 0; i < MAX_BT_PEERS; i++) {
    struct bt_peer *peer = &peer_info.peers[i];
    peer->mac = 0;
  }
  printf("Trigger to get bt peers:\r\n");
  command_print(peer_info.bt_peer_com);
  uint8_t buf[4];
 
  buf[0] = com->index && 0xff;
  buf[1] = (com->index >> (1 * 8)) && 0xff;
  buf[2] = (com->index >> (2 * 8)) && 0xff;
  buf[3] = (com->index >> (3 * 8)) && 0xff;
  cat_send_local_instruction(INSTRUCTION_BT_BLE_GET_PEERS, buf, 4);
  return 0;
}
// 00 == ok, bluetooth BLE write a characteristic
int esp32_bt_set_characteristic_com(struct command *com) {
  uint8_t buf[300];
  int j;
  int i;
 
  j = 0;
 
  const char *argbuf = get_arg(com, 0); // mac
  int ac = get_arg_size(com, 0);
 
  if (ac != 6) {
    printf("esp8266: invalid argument size #0 (should be 6, is %i)\r\n", ac);
    return 2;
  }
  for (i = 0; i < 6; i++) {
    buf[j++] = argbuf[i];
  }
 
  argbuf = get_arg(com, 1); // handle
  ac = get_arg_size(com, 1);
  if (ac != 2) {
    printf("esp8266: invalid argument size #1 (should be 2, is %i)\r\n", ac);
    return 2;
  }
  buf[j++] = argbuf[0];
  buf[j++] = argbuf[1];
 
  argbuf = get_arg(com, 2); // value
  ac = get_arg_size(com, 2);
  int avail = sizeof(buf) - 10;
 
  if ((ac + j) > avail) {
    printf("esp8266: Invalid argument size #2 (too long %i bytes), available: %i\n", ac, avail - j);
    return 2;
  }
  for (i = 0; i < ac; i++) {
    buf[j++] = argbuf[i];
  }
  cat_send_local_instruction(INSTRUCTION_BT_BLE_WRITE_CHAR, buf, j);
  return 1;
}
/*
 * triggers a "read characteristic". esp32 is supposed to send a command to us with the value once it received it from the remove device
 */
int esp32_bt_trigger_read_characteristic_com(struct command *com) {
  uint8_t buf[300];
  int j;
  int i;
 
  j = 0;
 
  const char *argbuf = get_arg(com, 0); // mac
  int ac = get_arg_size(com, 0);
 
  if (ac != 6) {
    printf("esp8266: invalid argument size #0 (should be 6, is %i)\r\n", ac);
    return 2;
  }
  for (i = 0; i < 6; i++) {
    buf[j++] = argbuf[i];
  }
 
  argbuf = get_arg(com, 1); // handle
  ac = get_arg_size(com, 1);
  if (ac != 2) {
    printf("esp8266: invalid argument size #1 (should be 2, is %i)\r\n", ac);
    return 2;
  }
  buf[j++] = argbuf[0];
  buf[j++] = argbuf[1];
 
 
  cat_send_local_instruction(INSTRUCTION_BT_BLE_READ_CHAR, buf, j);
  return 1;
}