tblock.cpp

Go to the documentation of this file.

#include "teensy/tblock.h"
 
using namespace blocks;
 
const SPISettings TBlockHAL_V_1_0_X::F_CONNECTION_SPI_SETTINGS{
    4'000'000, MSBFIRST,
    SPI_MODE2 /* Chip expects MODE0, CLK is inverted on the way, but MOSI is not, thus CLK must be shifted */};
 
FLASHMEM TBlockHAL_V_1_0_X::TBlockHAL_V_1_0_X(bus::addr_t block_address)
    : TBlockHAL_Parent(block_address), f_set_mux_disable{bus::replace_function_idx(block_address, 5)},
      f_reset_mux_disable{bus::replace_function_idx(block_address, 6)},
      f_reset_connections{bus::replace_function_idx(block_address, 4)},
      f_connections{bus::replace_function_idx(block_address, 2), F_CONNECTION_SPI_SETTINGS},
      f_connections_sync{bus::replace_function_idx(block_address, 3)} {}
 
FLASHMEM void TBlockHAL_V_1_0_X::set_mux_disable() { f_set_mux_disable.trigger(); }
 
FLASHMEM void TBlockHAL_V_1_0_X::reset_mux_disable() { f_reset_mux_disable.trigger(); }
 
FLASHMEM bool TBlockHAL_V_1_0_X::write_muxes(std::array<uint8_t, 96> muxes) {
  // Order of muxes in function argument is sources for output [bpl_ch0, cl0_ch0, cl1_ch0, cl2_ch0, bpl_ch1,
  // ... cl2_ch23]
  std::array<uint8_t, 24> data{};
  for (auto idx = 0u; idx < data.size(); idx++) {
    // Fill up MOSI buffer in reverse because MSBFirst flag doesnt mirror the byte order but only the bytes
    // alone
    data[data.size() - 1 - idx] =
        (muxes[idx * 4 + 3] << 6) | (muxes[idx * 4 + 2] << 4) | (muxes[idx * 4 + 1] << 2) | muxes[idx * 4 + 0];
  }
 
  auto success = f_connections.transfer(data.data(), nullptr, data.size());
  f_connections_sync.trigger();
  return success;
}
 
FLASHMEM bool TBlockHAL_V_1_0_X::reset_muxes() {
  f_reset_connections.trigger();
#ifdef ANABRID_PEDANTIC
  std::array<uint8_t, 24> data{0};
  f_connections.transfer(data.data(), data.data(), data.size());
  return std::all_of(data.begin(), data.end(), [](auto value) { return value == 0; });
#else
  return true;
#endif
}
 
FLASHMEM
TBlock *TBlock::from_entity_classifier(entities::EntityClassifier classifier, bus::addr_t block_address) {
  if (!classifier or classifier.class_enum != CLASS_ or classifier.type != TYPE)
    return nullptr;
 
  if (classifier.version < entities::Version(1, 0, 2))
    // Version 1.0.1 was manufactured without any muxers on them :)
    return nullptr;
  if (classifier.version < entities::Version(1, 1)) {
    auto *new_tblock = new TBlock(new TBlockHAL_V_1_0_X(block_address));
    new_tblock->classifier = classifier;
    return new_tblock;
  }
  return nullptr;
}