Seich
/
HomeSpan
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Starting work on ServoPin update

This commit is contained in:
HomeSpan 2021-09-12 12:31:08 -05:00
parent a5d31b1ea5
commit 0a0c536b6d
3 changed files with 72 additions and 55 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

99
src/extras/PwmPin.cpp
View File

@ -3,7 +3,7 @@
///////////////////
LedPin::LedPin(uint8_t pin, uint8_t level, uint16_t freq){
LedC::LedC(uint8_t pin, uint16_t freq){
if(freq==0)
freq=DEFAULT_PWM_FREQ;
@ -35,43 +35,49 @@ LedPin::LedPin(uint8_t pin, uint8_t level, uint16_t freq){
channelList[nChannel][nMode]->intr_type=LEDC_INTR_DISABLE;
channelList[nChannel][nMode]->hpoint=0;
channelList[nChannel][nMode]->gpio_num=pin;
ledTimer=timerList[nTimer][nMode];
ledChannel=channelList[nChannel][nMode];
set(level);
timer=timerList[nTimer][nMode];
channel=channelList[nChannel][nMode];
return;
}
}
}
}
}
}
}
}
}
}
///////////////////
LedPin::LedPin(uint8_t pin, uint8_t level, uint16_t freq) : LedC(pin, freq){
if(!channel)
Serial.printf("\n*** ERROR: Can't create LedPin(%d) - no open PWM channels and/or Timers ***\n\n",pin);
set(level);
}
///////////////////
void LedPin::set(uint8_t level){
if(!ledChannel)
if(!channel)
return;
Serial.printf("pin=%d, ch=%d, mode=%d, timer=%d, freq=%d, res=%d\n",
ledChannel->gpio_num,
ledChannel->channel,
ledChannel->speed_mode,
ledChannel->timer_sel,
ledTimer->freq_hz,
ledTimer->duty_resolution
channel->gpio_num,
channel->channel,
channel->speed_mode,
channel->timer_sel,
timer->freq_hz,
timer->duty_resolution
);
if(level>100)
level=100;
ledChannel->duty=level*(pow(2,ledTimer->duty_resolution)-1);
ledChannel->duty/=100;
ledc_channel_config(ledChannel);
channel->duty=level*(pow(2,timer->duty_resolution)-1);
channel->duty/=100;
ledc_channel_config(channel);
}
@ -134,37 +140,42 @@ void LedPin::HSVtoRGB(float h, float s, float v, float *r, float *g, float *b ){
////////////////////////////
ServoPin::ServoPin(uint8_t pin, double initDegrees, uint16_t minMicros, uint16_t maxMicros, double minDegrees, double maxDegrees){
if(numChannels>7 || numChannels>(15-LedPin::numChannels)){
Serial.printf("\n*** ERROR: Can't create ServoPin(%d) - no open PWM channels ***\n\n",pin);
servoChannel.gpio_num=0;
return;
}
ServoPin::ServoPin(uint8_t pin, double initDegrees, uint16_t minMicros, uint16_t maxMicros, double minDegrees, double maxDegrees) : LedC(pin, 50){
// if(numChannels>7 || numChannels>(15-numChannels)){
// Serial.printf("\n*** ERROR: Can't create ServoPin(%d) - no open PWM channels ***\n\n",pin);
// servoChannel.gpio_num=0;
// return;
// }
//
// enabled=true;
enabled=true;
if(!channel)
Serial.printf("\n*** ERROR: Can't create LedPin(%d) - no open PWM channels and/or Timers ***\n\n",pin);
set(initDegrees);
this->minMicros=minMicros;
this->maxMicros=maxMicros;
this->minDegrees=minDegrees;
microsPerDegree=(double)(maxMicros-minMicros)/(maxDegrees-minDegrees);
if(numChannels==0){ // first instantiation of a ServoPin
ledc_timer_config_t ledTimer;
ledTimer.timer_num=LEDC_TIMER_1;
ledTimer.speed_mode=LEDC_HIGH_SPEED_MODE;
ledTimer.duty_resolution=LEDC_TIMER_16_BIT;
ledTimer.freq_hz=50;
ledc_timer_config(&ledTimer);
}
servoChannel.gpio_num=pin;
servoChannel.speed_mode=LEDC_HIGH_SPEED_MODE;
servoChannel.channel=(ledc_channel_t)numChannels++;
servoChannel.intr_type=LEDC_INTR_DISABLE;
servoChannel.timer_sel=LEDC_TIMER_1;
servoChannel.hpoint=0;
servoChannel.duty*=micros2duty;
set(initDegrees);
// if(numChannels==0){ // first instantiation of a ServoPin
// ledc_timer_config_t ledTimer;
// ledTimer.timer_num=LEDC_TIMER_1;
// ledTimer.speed_mode=LEDC_HIGH_SPEED_MODE;
// ledTimer.duty_resolution=LEDC_TIMER_16_BIT;
// ledTimer.freq_hz=50;
// ledc_timer_config(&ledTimer);
// }
//
// servoChannel.gpio_num=pin;
// servoChannel.speed_mode=LEDC_HIGH_SPEED_MODE;
// servoChannel.channel=(ledc_channel_t)numChannels++;
// servoChannel.intr_type=LEDC_INTR_DISABLE;
// servoChannel.timer_sel=LEDC_TIMER_1;
// servoChannel.hpoint=0;
// servoChannel.duty*=micros2duty;
// set(initDegrees);
}
///////////////////
@ -187,10 +198,8 @@ void ServoPin::set(double degrees){
////////////////////////////
const double ServoPin::micros2duty=65535.0/20000.0;
uint8_t LedPin::numChannels=0;
//uint8_t LedPin::numChannels=0;
uint8_t ServoPin::numChannels=0;
uint8_t LedC::nChannels=0;
vector<ledc_timer_config_t> LedC::timers;
ledc_channel_config_t *LedC::channelList[LEDC_CHANNEL_MAX][LEDC_SPEED_MODE_MAX]={};
ledc_timer_config_t *LedC::timerList[LEDC_TIMER_MAX][LEDC_SPEED_MODE_MAX]={};

19
src/extras/PwmPin.h
View File

@ -33,30 +33,33 @@ using std::vector;
class LedC {
protected:
static uint8_t nChannels;
static vector<ledc_timer_config_t> timers;
static ledc_channel_config_t *channelList[LEDC_CHANNEL_MAX][LEDC_SPEED_MODE_MAX];
static ledc_timer_config_t *timerList[LEDC_TIMER_MAX][LEDC_SPEED_MODE_MAX];
ledc_channel_config_t *channel=NULL;
ledc_timer_config_t *timer;
LedC(uint8_t pin, uint16_t freq);
public:
int getPin(){return(channel?channel->gpio_num:-1);} // returns the pin number
};
/////////////////////////////////////
class LedPin : LedC {
ledc_channel_config_t *ledChannel=NULL;
ledc_timer_config_t *ledTimer;
class LedPin : public LedC {
public:
LedPin(uint8_t pin, uint8_t level=0, uint16_t freq=DEFAULT_PWM_FREQ); // assigns pin to be output of one of 16 PWM channels initial level and frequency
void set(uint8_t level); // sets the PWM duty to level (0-100)
int getPin(){return(ledChannel?ledChannel->gpio_num:-1);} // returns the pin number
static uint8_t numChannels;
static void HSVtoRGB(float h, float s, float v, float *r, float *g, float *b ); // converts Hue/Saturation/Brightness to R/G/B
};
/////////////////////////////////////
class ServoPin {
class ServoPin : public LedC {
boolean enabled=false;
uint16_t minMicros;
uint16_t maxMicros;

5
src/extras/extras.ino
View File

@ -36,6 +36,11 @@ void setup(){
led0.set(5);
led2.set(100);
Serial.println(led0.getPin());
Serial.println(led14.getPin());
Serial.println(led15.getPin());
Serial.println(led16.getPin());
uint32_t v=REG_READ(LEDC_HSTIMER0_CONF_REG);
Serial.printf("HS %d %d %d %d\n",(v>>25)&1,v&0x1f,(v>>13)&0x3FF,(v>>5)&0xFF);