C
#ifndef __SHSHAKEITPWM_H__
#define __SHSHAKEITPWM_H__
#include <Arduino.h>
#include "SHShakeitBase.h"
#include <EspSimHubPwm.h>
class SHShakeitPWM : public SHShakeitBase {
private:
byte pins[4];
byte mins[4];
byte maxs[4];
byte enabledOutputs;
int expectedFrequencyHz = 490;
#ifdef ESP32
ledc_components* outputs;
#endif
public:
uint8_t motorCount() {
return enabledOutputs;
}
String providerName() {
return "PWM";
}
void begin(byte pEnabledOutputs, byte pPin01, byte pPin02, byte pPin03, byte pPin04) {
pins[0] = pPin01;
pins[1] = pPin02;
pins[2] = pPin03;
pins[3] = pPin04;
enabledOutputs = pEnabledOutputs;
#ifdef ESP32
ledc_components* components = new ledc_components[pEnabledOutputs];
for (int i = 0; i < pEnabledOutputs; i++) {
components[i].pin = pins[i];
}
createPwmForDutyCycleControl(components, enabledOutputs, expectedFrequencyHz, 10);
outputs = components;
#endif
#ifdef ESP8266
analogWriteFreq(expectedFrequencyHz);
for (int i = 0; i < pEnabledOutputs; i++) {
pinMode(pins[i], OUTPUT);
analogWrite(pins[i], 0);
}
#endif
}
void setMin(byte pMin01, byte pMin02, byte pMin03, byte pMin04) {
mins[0] = pMin01;
mins[1] = pMin02;
mins[2] = pMin03;
mins[3] = pMin04;
}
void setMax(byte pMax01, byte pMax02, byte pMax03, byte pMax04) {
maxs[0] = pMax01;
maxs[1] = pMax02;
maxs[2] = pMax03;
maxs[3] = pMax04;
}
protected:
void setMotorOutput(uint8_t motorIdx, uint8_t value) {
double value2 = value;
if (value2 < mins[motorIdx]) {
value2 = 0;
}
else {
value2 = (value2) / 255.0 * (double)maxs[motorIdx];
}
#ifdef ESP8266
analogWrite(pins[motorIdx], (int)value2);
#endif
#ifdef ESP32
ledc_components components = outputs[motorIdx];
ledc_mode_t speedMode = components.channel.speed_mode;
ledc_channel_t channel = components.channel.channel;
ledc_set_duty(
speedMode,
channel,
value2
);
ledc_update_duty(
speedMode,
channel
);
#endif
}
};
#endif