h3n3/darkwater_python_escape
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Added correction factor

Browse Source
This commit is contained in:
shrkey
2016-04-03 12:25:57 +01:00
parent dab5d7fce4
commit 85d9a63fc8
1 changed files with 6 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
dwescape/Adafruit_PWM_Servo_Driver.py
View File

@@ -56,7 +56,7 @@ class PWM :
self.i2c.write8(self.__MODE1, mode1)
time.sleep(0.005) # wait for oscillator
def setPWMFreq(self, freq):
def setPWMFreq(self, freq, correctionFactor=1.0):
"Sets the PWM frequency"
prescaleval = 25000000.0 # 25MHz
prescaleval /= 4096.0 # 12-bit
@@ -65,7 +65,7 @@ class PWM :
if (self.debug):
print "Setting PWM frequency to %d Hz" % freq
print "Estimated pre-scale: %d" % prescaleval
prescale = math.floor(prescaleval + 0.5)
prescale = math.floor(prescaleval * correctionFactor + 0.5)
if (self.debug):
print "Final pre-scale: %d" % prescale
@@ -83,8 +83,10 @@ class PWM :
prescale = self.i2c.readU8(self.__PRESCALE)
print "Got pre-scale: %d" % prescale
print 25000000.0 / 4096.0 / ( float(prescale) + 1 )
if (self.debug):
print "Got pre-scale: %d" % prescale
print 25000000.0 / 4096.0 / ( float(prescale) + 1 )
return 25000000.0 / 4096.0 / ( float(prescale) + 1 )
#24576000.f / 4096.f / (data + 1)