feedc0de/bobbycar-controller-firmware
1
0
Fork 0
Code Issues 8 Pull Requests 5 Actions Packages Projects Releases Wiki Activity

Add Id Iq currents

Browse Source
This commit is contained in:
0xFEEDC0DE64
2022-04-26 23:14:40 +02:00
parent e60c2fa6d2
commit 1161ed6c42
2 changed files with 57 additions and 51 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
bobbycar-protocol

Submodule bobbycar-protocol updated: 2c6fb114f2...cb5939eefb

72
main.cpp
View File

@@ -1689,13 +1689,9 @@ void applyIncomingCanMessage()
} }
} }
void sendCanFeedback() template<typename T>
void send(uint32_t addr, T value)
{ {
const auto free = HAL_CAN_GetTxMailboxesFreeLevel(&CanHandle);
if (!free)
return;
constexpr auto send = [](uint32_t addr, auto value){
CAN_TxHeaderTypeDef header; CAN_TxHeaderTypeDef header;
header.StdId = addr; header.StdId = addr;
header.ExtId = 0x01; header.ExtId = 0x01;
@@ -1713,37 +1709,47 @@ void sendCanFeedback()
myPrintf("HAL_CAN_AddTxMessage() failed with %i", result); myPrintf("HAL_CAN_AddTxMessage() failed with %i", result);
//while (true); //while (true);
} }
}; }
void sendCanFeedback()
{
const auto free = HAL_CAN_GetTxMailboxesFreeLevel(&CanHandle);
if (!free)
return;
static uint8_t whichToSend{}; static uint8_t whichToSend{};
switch (whichToSend++)
{
using namespace protocol::can; using namespace protocol::can;
case 0: send(MotorController<isBackBoard, false>::Feedback::DcLink, left. rtU.i_DCLink); break; constexpr void(*arr[])() = {
case 1: send(MotorController<isBackBoard, true>:: Feedback::DcLink, right.rtU.i_DCLink); break; [](){ send(MotorController<isBackBoard, false>::Feedback::DcLink, left. rtU.i_DCLink); },
case 2: send(MotorController<isBackBoard, false>::Feedback::Speed, left. rtY.n_mot); break; [](){ send(MotorController<isBackBoard, true>:: Feedback::DcLink, right.rtU.i_DCLink); },
case 3: send(MotorController<isBackBoard, true>:: Feedback::Speed, right.rtY.n_mot); break; [](){ send(MotorController<isBackBoard, false>::Feedback::Speed, left. rtY.n_mot); },
case 4: send(MotorController<isBackBoard, false>::Feedback::Error, left. rtY.z_errCode); break; [](){ send(MotorController<isBackBoard, true>:: Feedback::Speed, right.rtY.n_mot); },
case 5: send(MotorController<isBackBoard, true>:: Feedback::Error, right.rtY.z_errCode); break; [](){ send(MotorController<isBackBoard, false>::Feedback::Error, left. rtY.z_errCode); },
case 6: send(MotorController<isBackBoard, false>::Feedback::Angle, left. rtY.a_elecAngle); break; [](){ send(MotorController<isBackBoard, true>:: Feedback::Error, right.rtY.z_errCode); },
case 7: send(MotorController<isBackBoard, true>:: Feedback::Angle, right.rtY.a_elecAngle); break; [](){ send(MotorController<isBackBoard, false>::Feedback::Angle, left. rtY.a_elecAngle); },
case 8: send(MotorController<isBackBoard, false>::Feedback::DcPhaA, left. rtY.DC_phaA); break; [](){ send(MotorController<isBackBoard, true>:: Feedback::Angle, right.rtY.a_elecAngle); },
case 9: send(MotorController<isBackBoard, true>:: Feedback::DcPhaA, right.rtY.DC_phaA); break; // [](){ send(MotorController<isBackBoard, false>::Feedback::DcPhaA, left. rtY.DC_phaA); },
case 10: send(MotorController<isBackBoard, false>::Feedback::DcPhaB, left. rtY.DC_phaB); break; // [](){ send(MotorController<isBackBoard, true>:: Feedback::DcPhaA, right.rtY.DC_phaA); },
case 11: send(MotorController<isBackBoard, true>:: Feedback::DcPhaB, right.rtY.DC_phaB); break; // [](){ send(MotorController<isBackBoard, false>::Feedback::DcPhaB, left. rtY.DC_phaB); },
case 12: send(MotorController<isBackBoard, false>::Feedback::DcPhaC, left. rtY.DC_phaC); break; // [](){ send(MotorController<isBackBoard, true>:: Feedback::DcPhaB, right.rtY.DC_phaB); },
case 13: send(MotorController<isBackBoard, true>:: Feedback::DcPhaC, right.rtY.DC_phaC); break; // [](){ send(MotorController<isBackBoard, false>::Feedback::DcPhaC, left. rtY.DC_phaC); },
case 14: send(MotorController<isBackBoard, false>::Feedback::Chops, left. chops.exchange(0)); break; // [](){ send(MotorController<isBackBoard, true>:: Feedback::DcPhaC, right.rtY.DC_phaC); },
case 15: send(MotorController<isBackBoard, true>:: Feedback::Chops, right.chops.exchange(0)); break; [](){ send(MotorController<isBackBoard, false>::Feedback::Chops, left. chops.exchange(0)); },
case 16: send(MotorController<isBackBoard, false>::Feedback::Hall, left.hallBits()); break; [](){ send(MotorController<isBackBoard, true>:: Feedback::Chops, right.chops.exchange(0)); },
case 17: send(MotorController<isBackBoard, true>:: Feedback::Hall, right.hallBits()); break; [](){ send(MotorController<isBackBoard, false>::Feedback::Hall, left.hallBits()); },
case 18: send(MotorController<isBackBoard, false>::Feedback::Voltage, batVoltage * BAT_CALIB_REAL_VOLTAGE / BAT_CALIB_ADC); break; [](){ send(MotorController<isBackBoard, true>:: Feedback::Hall, right.hallBits()); },
case 19: send(MotorController<isBackBoard, true>:: Feedback::Voltage, batVoltage * BAT_CALIB_REAL_VOLTAGE / BAT_CALIB_ADC); break; [](){ send(MotorController<isBackBoard, false>::Feedback::Voltage, batVoltage * BAT_CALIB_REAL_VOLTAGE / BAT_CALIB_ADC); },
case 20: send(MotorController<isBackBoard, false>::Feedback::Temp, board_temp_deg_c); break; [](){ send(MotorController<isBackBoard, true>:: Feedback::Voltage, batVoltage * BAT_CALIB_REAL_VOLTAGE / BAT_CALIB_ADC); },
case 21: send(MotorController<isBackBoard, true>:: Feedback::Temp, board_temp_deg_c); whichToSend = 0; break; [](){ send(MotorController<isBackBoard, false>::Feedback::Temp, board_temp_deg_c); },
default: myPrintf("unreachable"); [](){ send(MotorController<isBackBoard, true>:: Feedback::Temp, board_temp_deg_c); },
} [](){ send(MotorController<isBackBoard, false>::Feedback::Id, left. rtY.id); },
[](){ send(MotorController<isBackBoard, true>:: Feedback::Id, right.rtY.id); },
[](){ send(MotorController<isBackBoard, false>::Feedback::Iq, left. rtY.iq); },
[](){ send(MotorController<isBackBoard, true>:: Feedback::Iq, right.rtY.iq); whichToSend = 0; },
};
arr[whichToSend++]();
} }
#endif #endif