shblock.cpp

Go to the documentation of this file.

// Copyright (c) 2024 anabrid GmbH
// Contact: https://www.anabrid.com/licensing/
//
// SPDX-License-Identifier: MIT OR GPL-2.0-or-later
 
#include <block/shblock.h>
#include <entity/meta.h>
 
#include "teensy/shblock.h"
 
FLASHMEM
blocks::SHBlock *blocks::SHBlock::from_entity_classifier(entities::EntityClassifier classifier,
                                                         bus::addr_t block_address) {
  if (!classifier or classifier.class_enum != CLASS_)
    return nullptr;
 
  // Currently, there are no different variants
  if (classifier.variant != entities::EntityClassifier::DEFAULT_)
    return nullptr;
 
  if (classifier.version < entities::Version(0, 1))
    return nullptr;
  if (classifier.version < entities::Version(0, 2)) {
    auto *new_block = new SHBlock(new SHBlockHAL_V_0_1_X(block_address));
    new_block->classifier = classifier;
    return new_block;
  }
  return nullptr;
}
 
blocks::SHBlockHAL_V_0_1_X::SHBlockHAL_V_0_1_X(bus::addr_t block_address)
    : SHBlockHAL_Parent(block_address),
      set_track(bus::replace_function_idx(block_address, 2)),
      set_track_at_ic(bus::replace_function_idx(block_address, 3)),
      set_gain(bus::replace_function_idx(block_address, 4)),
      set_gain_channels_zero_to_seven(bus::replace_function_idx(block_address, 5)),
      set_gain_channels_eight_to_fifteen(bus::replace_function_idx(block_address, 6)),
      set_inject(bus::replace_function_idx(block_address, 7)) {}
 
FLASHMEM void blocks::SHBlockHAL_V_0_1_X::compensate_hardware_offsets(uint32_t track_time,
                                                                      uint32_t inject_time) {
  set_track.trigger();
  delayMicroseconds(track_time);
  set_inject.trigger();
  delayMicroseconds(inject_time);
}
 
FLASHMEM void blocks::SHBlockHAL_V_0_1_X::set_state(SHState state) const {
  switch (state) {
  case SHState::TRACK:
    set_track.trigger();
    break;
  case SHState::TRACK_AT_IC:
    set_track_at_ic.trigger();
    break;
  case SHState::INJECT:
    set_inject.trigger();
    break;
  case SHState::GAIN_ZERO_TO_SEVEN:
    set_gain.trigger();
    set_gain_channels_zero_to_seven.trigger();
    break;
  case SHState::GAIN_EIGHT_TO_FIFTEEN:
    set_gain.trigger();
    set_gain_channels_eight_to_fifteen.trigger();
    break;
  }
}