servo.c 1.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657
  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. #include <stdio.h>
  26. #include <errno.h>
  27. #include <string.h>
  28. #include <wiringPi.h>
  29. #include <softServo.h>
  30. int main ()
  31. {
  32. if (wiringPiSetup () == -1)
  33. {
  34. fprintf (stdout, "oops: %s\n", strerror (errno)) ;
  35. return 1 ;
  36. }
  37. softServoSetup (0, 1, 2, 3, 4, 5, 6, 7) ;
  38. softServoWrite (0, 0) ;
  39. /*
  40. softServoWrite (1, 1000) ;
  41. softServoWrite (2, 1100) ;
  42. softServoWrite (3, 1200) ;
  43. softServoWrite (4, 1300) ;
  44. softServoWrite (5, 1400) ;
  45. softServoWrite (6, 1500) ;
  46. softServoWrite (7, 2200) ;
  47. */
  48. for (;;)
  49. delay (10) ;
  50. }