Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- /* TITULO: Programar posiciones en un Micro Servo Tower Pro SG90 9G.
- AUTOR:
- MARIANO DEL CAMPO GARCÍA (@2016) --> INGENIERO TÉCNICO INDUSTRIAL ESPECIALIDAD ELECTRÓNICA
- - FACEBOOK: https://www.facebook.com/mariano.delcampogarcia
- - TWITTER: https://twitter.com/MarianoCampoGa
- - CORREO: marianodc83@gmail.com
- DESCRIPCIÓN DEL PROGRAMA
- Cargando el siguiente programa en nuestro Arduino, seremos capaces de mover el servo desde la posición
- de 0° hasta los 180° y viceversa (de 180° a 0°), con una velocidad de 1 grado cada 10 ms (1,8 segundos
- el ciclo completo, es decir, los 180º).
- ESQUEMA DE CONEXION
- +-----+
- +----[PWR]-------------------| USB |--+
- | +-----+ |
- | GND/RST2 [ ][ ] |
- | MOSI2/SCK2 [ ][ ] A5/SCL[ ] |
- | 5V/MISO2 [ ][ ] A4/SDA[ ] |
- | AREF[ ] |
- | GND[ ] |
- | [ ]N/C SCK/13[ ] |
- | [ ]IOREF MISO/12[ ] |
- | [ ]RST MOSI/11[ ]~|
- | [ ]3V3 +---+ 10[ ]~|
- | [ ]5v -| A |- 9[ ]~| Cable color "Naranja" del Servo
- | [ ]GND -| R |- 8[ ] |
- | [ ]GND -| D |- |
- | [ ]Vin -| U |- 7[ ] |
- | -| I |- 6[ ]~|
- | [ ]A0 -| N |- 5[ ]~|
- | [ ]A1 -| O |- 4[ ] |
- | [ ]A2 +---+ INT1/3[ ]~|
- | [ ]A3 INT0/2[ ] |
- | [ ]A4/SDA RST SCK MISO TX>1[ ] |
- | [ ]A5/SCL [ ] [ ] [ ] RX<0[ ] |
- | [ ] [ ] [ ] |
- | UNO_R3 GND MOSI 5V ____________/
- \_______________________/
- NOTAS:
- - Cable color "Café" del Servo --> GND
- - Cable color "Rojo" del Servo --> +5V
- */
- // Incluir la librería Servo
- #include <Servo.h>
- Servo servo1;
- int pinServo = 9; // Pin digital con PWM para el Servo
- int pulsoMin = 650; // Pulso en us para girar un ángulo de 0º
- int pulsoMax = 2550; // Pulso en us para girar un ángulo de 180º
- int angulo = 0; // Variable para guardar el ángulo del servo
- void setup()
- {
- // Señal del Servo1 conectado al pin digital 9 (PWM)--> pinServo
- // Calibración del servo para suavizar movimientos -->(pulsoMin, pulsoMax)
- servo1.attach(pinServo, pulsoMin, pulsoMax);
- }
- void loop()
- {
- // El Servo avanza de 0º a 180º
- for(angulo = 0; angulo <= 180; angulo++)
- {
- // Avanza 1 grado cada 10 ms
- servo1.write(angulo);
- delay(10);
- }
- // El Servo retrocede de 180º a 0º
- for(angulo = 180; angulo >= 0; angulo--)
- {
- // Retrocede 1 grado cada 10 ms
- servo1.write(angulo);
- delay(10);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement