This lesson will show how to use Python running on the Beaglebone Black to control the position of a servo. First, I am using a small servo that I have verified can be powered from the Beaglebone Black without drawing too much current. All servos are different, so if you are unsure of the current requirements of your servo, it is safest to power it from an external 5 Volt power source. You can still control it through the control line connected to the Beaglebone Black, just make sure the servo and Beaglebone have a common ground.
Most all servos have three wires; Power, Control, and Ground. For my servo, Control is Yellow, Power is Red, and Ground is Black. If you have a different servo, check the data sheet to see what colors are Control, Power and Ground on your servo. Note we are using pin P9_2 as ground, P9_7 as 5V power, and P9_14 as our control pin.
We will be controlling the position of the servo using PWM. We will have to play around with our individual servo to determine precisely what signal pulse width will result in the servo being in the full left position, and what pulse width will result in the servo being in the full right position.
For most servos, full left is somewhere around 1 milliseconds, and the pulse width that will give us full right position is about 2 milliseconds. These are ballpark numbers, and we will have to play around with things to find the exact values for our servo.
We will set up a 50 Hz PWM signal. A 50 Hz signal has a period of:
period = 1/frequency = .02 seconds = 20 miliseconds.
Hence, if we want to get to about the full left position we would want a duty cycle of about 5%. Because 20 milliseconds x .05 = 1 milliseconds. This one millisecond pulse width should put the servo about in the full left position. Similarly for the full right position, we would want a duty cycle of 10%, because that would give us a pulse width of 2 milliseconds, since:
PulseWidth = Period x DutyCycle
PulseWidth = 20 x .1 = 2 milliseconds.
We can use the following code to determine precisely for our servo what dutyCycle will give the precise full left and full right positions.
import Adafruit_BBIO.PWM as PWM
dutyCycle=input("What Duty Cycle? ")
For my servo, running a 50 Hz PWM singnal, I find that a duty cycle of 2% puts it in the full left position and a duty cycle of 12% puts it in the full right position.
Now we would like to be able to just specify an angle we want and have it go to that angle. If we want an angle of 0 degrees we would apply a 2% duty cycle. This value is for my servo. You will have to play around with your servo and the code above to find what this number is for you. But for me, I have the point:
That is to say when I desire an angle of 0 on the servo, I should apply a dutyCycle of 2 to the PWM pin. Similarly, when I desire 180 degrees, I should apply a dutyCycle of 12. (Again, this number might vary for your servo). For my servo, I get the point:
We can fit a line to these points, which would then allow us to calculate the dutyCycle for any desired angle. The slope from the two points above would be:
m=(y2-y1)/(x2-x1)=(12-2)/(180-0) = 10/180= 1/18
Using the point slope form of the line, we would get
y-y1 = m (x- x1)
y – 2 = 1/18( x – 0)
y= 1/18*x + 2
Now putting in our actual variable names we get:
dutyCycle = 1/18*desiredAngle + 2
You can develop the same type equation just using the values suitable for your servo from the experiment above.
Now we can use this code to smoothly move the servo to any desired position.
import Adafruit_BBIO.PWM as PWM
desiredAngle=input("What Angle do You Want")
dutyCycle=1./18.*desiredAngle + 2