nbus/Src/nbus_slave_module_unicast.c

#include <nbus_slave.h>

#if MODULE_SLAVE == 1

void nbus_slave_unicastToModuleGet(nBus_TypeDef *nbus) {
  switch (nbus->function_code.function) {

  case CMD_ECHO: {
    for (uint8_t i = 3; i < nbus->rx_length - 1; i++) {
      nbus->tx_buffer[i + 1] = nbus->rx_buffer[i];
    }
    nbus->tx_length += (nbus->rx_length - 4);
  }

  break;

  case CMD_PARAM: {
    // same as nbus_unicastToSensorSet
    int32_t param_value =
        nbus->interface->getParam(0, (nBus_param_t)nbus->rx_buffer[3]);
    if (param_value == PARAM_VALUE_NONE) {
      setErrorResponse(nbus, PARAM_NOT_IMPLEMENTED);
      break;
    }

    nbus->tx_buffer[4] = (uint8_t)(param_value & 0xFF);
    nbus->tx_buffer[5] = (uint8_t)((param_value >> 8) & 0xFF);
    nbus->tx_buffer[6] = (uint8_t)((param_value >> 16) & 0xFF);
    nbus->tx_buffer[7] = (uint8_t)((param_value >> 24) & 0xFF);

    nbus->tx_length += 4;
  } break;

  case CMD_SENSOR_CNT: {
    nbus->tx_buffer[4] = nbus->interface->getSensorCount();
    nbus->tx_length += 1;
  } break;

  case CMD_DATA: {
    if (nbus->measure_active == MEASURE_RUNNING) {
      // response: sensor1_index:sensor1_data | sensor2_index:sensor2_data | ...
      uint8_t cnt = nbus->interface->getData(0, &nbus->tx_buffer[4]);
      if (cnt == 0) {
        setErrorResponse(nbus, DEVICE_BUSY);
      }
      nbus->tx_length += cnt;

    } else {
      setErrorResponse(nbus, DEVICE_NOT_READY);
    }

  } break;

  case CMD_SENSOR_TYPE: {
    // response: sensor1_index:sensor1_type | sensor2_index:sensor2_type | ...
    for (uint8_t i = 0; i < nbus->interface->getSensorCount(); i++) {
      nbus->tx_buffer[4 + 2 * i] = i;
      nbus->tx_buffer[5 + 2 * i] = nbus->interface->getType(i);
      nbus->tx_length += 2;
    }
  } break;

  case CMD_INFO: {
    switch (nbus->rx_buffer[3]) {
    case INFO_MODULE_NAME:
      nbus->tx_buffer[4] = MODULE_NAME[0];
      nbus->tx_buffer[5] = MODULE_NAME[1];
      nbus->tx_buffer[6] = MODULE_NAME[2];
      nbus->tx_buffer[7] = MODULE_NAME[3];
      nbus->tx_buffer[8] = MODULE_NAME[4];
      nbus->tx_buffer[9] = MODULE_NAME[5];
      nbus->tx_buffer[10] = MODULE_NAME[6];
      nbus->tx_buffer[11] = MODULE_NAME[7];
      nbus->tx_length += 8;
      break;
    case INFO_MODULE_TYPE:
      nbus->tx_buffer[4] = MODULE_TYPE[0];
      nbus->tx_buffer[5] = MODULE_TYPE[1];
      nbus->tx_buffer[6] = MODULE_TYPE[2];
      nbus->tx_length += 3;
      break;
    case INFO_MODULE_UUID:
      // Reference manual: Unique device ID registers
      uint32_t(*unique_id_3) =
          (uint32_t *)(0x1FF80064); // BASE address + 0x14 0ffset
      *(nbus->tx_buffer) = (uint32_t)unique_id_3;
      nbus->tx_length += 4;
      break;
    case INFO_MODULE_FW:
      nbus->tx_buffer[4] = VERSION_FW[0];
      nbus->tx_buffer[5] = '.';
      nbus->tx_buffer[6] = VERSION_FW[1];
      nbus->tx_length += 3;
      break;
    case INFO_MODULE_HW:
      nbus->tx_buffer[4] = VERSION_HW[0];
      nbus->tx_buffer[5] = '.';
      nbus->tx_buffer[6] = VERSION_HW[1];
      nbus->tx_length += 3;
      break;
    case INFO_MODULE_MEMORY_ID: {
      uint8_t n = nbus->memoryInterface->getId(&nbus->tx_buffer[4]);
      nbus->tx_length += n;
    }
    }
  } break;

  default: {
    setErrorResponse(nbus, ILLEGAL_FUNCTION);
  }
  }
}

void nbus_slave_unicastToModuleSet(nBus_TypeDef *nbus) {
  switch (nbus->function_code.function) {
  case CMD_PARAM: {
    // same as nbus_unicastToSensorSet
    int32_t param_value = nbus->rx_buffer[4] | nbus->rx_buffer[5] << 8 |
                          nbus->rx_buffer[6] << 16 << nbus->rx_buffer[7] << 23;
    nBus_param_t p = nbus->interface->setParam(
        0, (nBus_param_t)nbus->rx_buffer[3], param_value);
    if (p == PARAM_NONE) {
      setErrorResponse(nbus, PARAM_NOT_IMPLEMENTED);
      break;
    }
    nbus->tx_buffer[4] = OK_CODE;
    nbus->tx_length += 1;
  } break;

  case CMD_DATA: {
    nbus->tx_buffer[4] = nbus->interface->setData(&nbus->rx_buffer[3]);
    if (nbus->tx_buffer[4] != OK_CODE) {
      nbus->function_code.error = 1;
    }

    nbus->tx_length += 1;
  } break;

  case CMD_SLEEP: {
    nbus->tx_buffer[4] = OK_CODE;
    nbus->tx_length += 1;
  } break;

  case CMD_WAKEUP: {
    nbus->tx_buffer[4] = OK_CODE;
    nbus->tx_length += 1;
  }

  case CMD_STORE: {
    if (nbus->interface->store != NULL) {
      nbus->interface->store();
      nbus->tx_buffer[4] = OK_CODE;
    } else {
      nbus->tx_buffer[4] = ILLEGAL_FUNCTION;
    }

    nbus->tx_length += 1;
  } break;

  default: {
    setErrorResponse(nbus, ILLEGAL_FUNCTION);
  }
  }
}

#endif