examples/servo.c

   1 /*
   2  * servo.c:
   3  *      Test of the softServo code.
   4  *      Do not use this code - use the servoBlaster kernel module instead
   5  *
   6  * Copyright (c) 2012-2013 Gordon Henderson. <projects@drogon.net>
   7  ***********************************************************************
   8  * This file is part of wiringPi:
   9  *      https://projects.drogon.net/raspberry-pi/wiringpi/
  10  *
  11  *    wiringPi is free software: you can redistribute it and/or modify
  12  *    it under the terms of the GNU Lesser General Public License as published by
  13  *    the Free Software Foundation, either version 3 of the License, or
  14  *    (at your option) any later version.
  15  *
  16  *    wiringPi is distributed in the hope that it will be useful,
  17  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  *    GNU Lesser General Public License for more details.
  20  *
  21  *    You should have received a copy of the GNU Lesser General Public License
  22  *    along with wiringPi.  If not, see <http://www.gnu.org/licenses/>.
  23  ***********************************************************************
  24  */
  25
  26 #include <stdio.h>
  27 #include <errno.h>
  28 #include <string.h>
  29
  30 #include <wiringPi.h>
  31 #include <softServo.h>
  32
  33 int main ()
  34 {
  35   if (wiringPiSetup () == -1)
  36   {
  37     fprintf (stdout, "oops: %s\n", strerror (errno)) ;
  38     return 1 ;
  39   }
  40
  41   softServoSetup (0, 1, 2, 3, 4, 5, 6, 7) ;
  42
  43   softServoWrite (0,  0) ;
  44 /*
  45   softServoWrite (1, 1000) ;
  46   softServoWrite (2, 1100) ;
  47   softServoWrite (3, 1200) ;
  48   softServoWrite (4, 1300) ;
  49   softServoWrite (5, 1400) ;
  50   softServoWrite (6, 1500) ;
  51   softServoWrite (7, 2200) ;
  52 */
  53
  54   for (;;)
  55     delay (10) ;
  56
  57 }