1
0
mirror of https://github.com/DCC-EX/CommandStation-EX.git synced 2024-11-22 15:46:14 +01:00

Add DC signal generation code.

This commit is contained in:
Asbelos 2022-03-02 15:34:01 +00:00
parent 524afc6caf
commit 678cccbd95

View File

@ -167,10 +167,17 @@ int MotorDriver::getCurrentRaw() {
}
void MotorDriver::setDCSignal(byte speedcode) {
// spedcxode is a dcc speed /direction
// TODO jiggle the DC speed pin PWMs
// spedcoode is a dcc speed /direction
byte tSpeed=speedcode & 0x7F;
// DCC Speed with 0,1 stop and speed steps 2 to 127
byte brake;
if (tSpeed <= 1) brake = 255;
else if (tSpeed >= 127) brake = 0;
else brake = 2 * (128-tSpeed);
analogWrite(brakePin,brake);
setSignal(speedcode & 0x80);
}
int MotorDriver::getCurrentRawInInterrupt() {
// IMPORTANT: This function must be called in Interrupt() time within the 56uS timer