5#include <proto/main.pb.h>
10#include "block/mblock_mul.h"
13#include "utils/logging.h"
15#include "entity/entity.h"
17#include "carrier/carrier.h"
18#include "carrier/cluster.h"
19#include "entity/visitor.h"
21extern int abs_clamp(
float in,
int min,
int max);
23bool blocks::MMulBlock::write_to_hardware() {
return write_calibration_to_hardware(); }
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);
32 return UnitResult::ok();
35blocks::MMulBlock::MMulBlock(SLOT slot, MMulBlockHAL *hardware)
36 : MBlock(slot, hardware), hardware(hardware) {
37 classifier.type =
static_cast<uint8_t
>(TYPE);
40bool blocks::MMulBlock::init() {
42 return FunctionBlock::init() && hardware->init();
45void blocks::MMulBlock::reset(entities::ResetAction action) {
46 FunctionBlock::reset(action);
48 if (action.has(entities::ResetAction::CALIBRATION_RESET)) {
49 for (
auto idx = 0u; idx < MMulBlock::NUM_MULTIPLIERS; idx++)
50 calibration[idx] = {};
53 if (action.has(entities::ResetAction::OVERLOAD_RESET)) {
54 hardware->reset_overload_flags();
59const std::array<blocks::MultiplierCalibration, blocks::MMulBlock::NUM_MULTIPLIERS> &
60blocks::MMulBlock::get_calibration()
const {
64blocks::MultiplierCalibration blocks::MMulBlock::get_calibration(uint8_t mul_idx)
const {
65 if (mul_idx >= NUM_MULTIPLIERS)
67 return calibration[mul_idx];
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;
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,
87ConfigResult blocks::MMulBlock::config(
const pb_Item &item) {
88 if (item.which_kind != pb_Item_mul_config_tag)
89 return ConfigResult::ok(
false);
92 return ConfigResult::ok(
true);
int abs_clamp(float in, int min, int max)