REDAC HybridController
Firmware for LUCIDAC/REDAC Teensy
Loading...
Searching...
No Matches
mblock_mul.cpp
Go to the documentation of this file.
1// Copyright (c) 2024 anabrid GmbH
2// Contact: https://www.anabrid.com/licensing/
3// SPDX-License-Identifier: MIT OR GPL-2.0-or-later
4
5#include <proto/main.pb.h>
6
7#include <algorithm>
8#include <bitset>
9
10#include "block/mblock_mul.h"
11
12#include "pb_decode.h"
13#include "utils/logging.h"
14
15#include "entity/entity.h"
16
17#include "carrier/carrier.h"
18#include "carrier/cluster.h"
19#include "entity/visitor.h"
20
21extern int abs_clamp(float in, int min, int max);
22
23bool blocks::MMulBlock::write_to_hardware() { return write_calibration_to_hardware(); }
24
25UnitResult blocks::MMulBlock::write_calibration_to_hardware() {
26 for (size_t i = 0; i < MMulBlock::NUM_MULTIPLIERS; i++) {
27 if (!hardware->write_calibration_input_offsets(i, calibration[i].offset_x, calibration[i].offset_y))
28 return UnitResult::err_fmt("MMulBlock::calibration for multiplier %d values offset_x, offset_y not accepted", i);
29 if (!hardware->write_calibration_output_offset(i, calibration[i].offset_z))
30 return UnitResult::err_fmt("MMulBlock::calibration for multiplier %d values offset_z not accepted", i);
31 }
32 return UnitResult::ok();
33}
34
35blocks::MMulBlock::MMulBlock(SLOT slot, MMulBlockHAL *hardware)
36 : MBlock(slot, hardware), hardware(hardware) {
37 classifier.type = static_cast<uint8_t>(TYPE);
38}
39
40bool blocks::MMulBlock::init() {
41 // TODO: Remove once hardware pointer is part of FunctionBlock base class
42 return FunctionBlock::init() && hardware->init();
43}
44
45void blocks::MMulBlock::reset(entities::ResetAction action) {
46 FunctionBlock::reset(action);
47
48 if (action.has(entities::ResetAction::CALIBRATION_RESET)) {
49 for (auto idx = 0u; idx < MMulBlock::NUM_MULTIPLIERS; idx++)
50 calibration[idx] = {};
51 }
52
53 if (action.has(entities::ResetAction::OVERLOAD_RESET)) {
54 hardware->reset_overload_flags();
55 }
56}
57
58
59const std::array<blocks::MultiplierCalibration, blocks::MMulBlock::NUM_MULTIPLIERS> &
60blocks::MMulBlock::get_calibration() const {
61 return calibration;
62}
63
64blocks::MultiplierCalibration blocks::MMulBlock::get_calibration(uint8_t mul_idx) const {
65 if (mul_idx >= NUM_MULTIPLIERS)
66 return {};
67 return calibration[mul_idx];
68}
69
70void blocks::MMulBlock::extract(entities::ExtractVisitor &collector) {
71 if (!collector.include_configuration() && !collector.include_calibration()) return;
72 auto& config = collector.create(pb_Item_mul_config_tag);
73 auto& mul_config = config.kind.mul_config = pb_MulConfig_init_default;
74
75 for (int idx = 0; idx < MMulBlock::NUM_MULTIPLIERS; idx++) {
76 if (collector.include_calibration()) {
77 mul_config.calibration[mul_config.calibration_count++] = {
78 .offset_x = calibration[idx].offset_x,
79 .offset_y = calibration[idx].offset_y,
80 .offset_z = calibration[idx].offset_z,
81 .gain = calibration[idx].gain,
82 };
83 }
84 }
85}
86
87ConfigResult blocks::MMulBlock::config(const pb_Item &item) {
88 if (item.which_kind != pb_Item_mul_config_tag)
89 return ConfigResult::ok(false);
90
91 //TODO: remove calibration from config entirein extract method?
92 return ConfigResult::ok(true);
93}
int abs_clamp(float in, int min, int max)
Definition mblock.cpp:20