Servo 1
Servo 1
Servo 1
pbp
'---------------Title-------------' ' ' ' ' ' File......servo1.pbp Started....1/8/08 Microcontroller used:
Microchip Technology 16F88 microchip.com PicBasic Pro Code: micro-Engineering Labs, Inc. melabs.com
'--------Program Desciption-------' ' ' ' Basic servo program with the format for controlling servo pulses using PicBasic Pro PULSOUT command. Servo cycles between counterclockwise and clockwise positions.
'----------Related Lesson---------' servo1.pbp is used in the lesson PIC PROGRAMMING 3 SERVOS at: ' http://cornerstonerobotics. org/curriculum/lessons_year2/erii13_pic_programming3_servos.pdf ' servo1.pbp is also used in the lesson HACKING SERVOS at: ' http://www.cornerstonerobotics. org/curriculum/lessons_year2/erii17_hacking_servos.pdf '------------Comments-------------' WITH THE PIC16F88, MAKE SURE TO HAVE SEPARATE POWER ' SOURCES FOR THE PIC AND THE SERVO. MAKE SURE TO ' HAVE A COMMON GROUND BETWEEN THE PIC AND SERVO. We use one 9V ' battery and two 78L05 voltage regulators. See ' discussion about voltage regulators at: ' http://cornerstonerobotics. org/curriculum/lessons_year2/erii3_diodes_power_supplies_voltage_reg.pdf ' Also, initialize the state of PORTB, (PORTB = 0), as LOW ' since that will set the correct polarity of the ' PULSOUT statement. ' Discussion about basic servo pulse control may be found ' at www.seattlerobotics.org/guide/servos.html or ' www.geocities.com/hobby_robotics/was.htm ' Servos may be modified or hacked to allow ' for continuous rotation so they can be used ' as motors on small robots. The book ' Amphibionics by Karl Williams gives an ' in depth treatment on how to modify servos. ' Also see Lesson 17, Hacking Servos at: ' http://www.cornerstonerobotics. org/curriculum/lessons_year2/erii17_hacking_servos.pdf '-----New PicBasic Pro Commands----
Page 1 of 3
1/31/2009 8:38 AM
' The PicBasic Pro Compiler Manual is on line at: ' http://www.microengineeringlabs.com/resources/index.htm#Manuals ' ' ' ' ' ' ' ' ' ' ' ' ' ' ' PULSOUT pin, period This command sends a pulse to pin for the period defined. For example: PULSOUT 0,200 Sends a pulse out on pin RB0 for 2.0 ms. The period,(200), is multiplied by the increment for a 4 MHz oscillator (10 us) to get a pulse out time of 2.0 ms.
Look around page 121 in the PicBasic Pro Compiler Manual Another PBP command that may be substituted for PULSOUT is PAUSEUS. See: http://cornerstonerobotics.org/code/servo2.pdf
'---------PIC Connections---------' ' ' ' ' ' PIC16F88 Pin --------RB0 Vdd Vss MCLR Wiring ---------Servo Control Wire +5 V Ground 4.7K Resistor to +5 V
'----------Initialization---------PORTB = %00000000 ' ' ' ' ' ' ' ' Eqivalent to: PORTB = 0 Sets all PORTB pins to LOW(0 volts) Make certain to include this initialization as it sets the proper polarity of pulses in the PULSOUT command. To set just one pin such as RB0, to LOW, enter PORTB.0 = 0.
ANSEL = 0
' Configure all pins to digital ' operation since not using ADC ' (Analog to Digital Converter) ' Sets the internal oscillator in the ' 16F88 to 4 MHz
OSCCON = $60
Page 2 of 3
1/31/2009 8:38 AM
' Send signal 40 times. To change the time ' the servo remains in one position, change ' from 40 to another value. PULSOUT 0,100 ' ' ' ' ' ' ' ' ' ' Pulse Width: Sends a pulse out on pin RB0 for 1.0 ms. The period,(100), is multiplied by the increment for a 4 MHz oscillator (10 us) to get a pulse out time of 1.0 ms. Pulse Interval: Pause 20 ms less pulse width (1.0 ms) This equation keeps the period of the servo pulse a constant 20 ms, HIGH for 1 ms and LOW for 19 ms = 20 ms.
PAUSE 20 - 1
' Go back to the FOR statement and do ' next count ' Send clockwise signal 40 times ' ' ' ' ' ' ' ' ' ' Pulse Width: Sends a pulse out on pin RB0 for 2.0 ms. The period,(200), is multiplied by the increment for a 4 MHz oscillator (10 us) to get a pulse out time of 2.0 ms. Pulse Interval: Pause 20 ms less pulse width (2.0 ms) This equation keeps the period of the servo pulse a constant 20 ms, HIGH for 2 ms and LOW for 18 ms = 20 ms.
PAUSE 20 - 2
' Go back to the FOR statement and do ' next count ' Makes the program run forever.
Page 3 of 3
1/31/2009 8:38 AM