nrf52_servo.py 2.0 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950
  1. # This file is part of the MicroPython project, http://micropython.org/
  2. #
  3. # The MIT License (MIT)
  4. #
  5. # Copyright (c) 2017 Glenn Ruben Bakke
  6. #
  7. # Permission is hereby granted, free of charge, to any person obtaining a copy
  8. # of this software and associated documentation files (the "Software"), to deal
  9. # in the Software without restriction, including without limitation the rights
  10. # to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  11. # copies of the Software, and to permit persons to whom the Software is
  12. # furnished to do so, subject to the following conditions:
  13. #
  14. # The above copyright notice and this permission notice shall be included in
  15. # all copies or substantial portions of the Software.
  16. #
  17. # THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  18. # IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  19. # FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  20. # AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  21. # LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  22. # OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  23. # THE SOFTWARE
  24. import time
  25. from machine import PWM, Pin
  26. class Servo():
  27. def __init__(self, pin_name=""):
  28. if pin_name:
  29. self.pin = Pin(pin_name, mode=Pin.OUT, pull=Pin.PULL_DOWN)
  30. else:
  31. self.pin = Pin("P22", mode=Pin.OUT, pull=Pin.PULL_DOWN)
  32. def left(self):
  33. p = PWM(0, self.pin, freq=PWM.FREQ_125KHZ, pulse_width=105, period=2500, mode=PWM.MODE_HIGH_LOW)
  34. p.init()
  35. time.sleep_ms(200)
  36. p.deinit()
  37. def center(self):
  38. p = PWM(0, self.pin, freq=PWM.FREQ_125KHZ, pulse_width=188, period=2500, mode=PWM.MODE_HIGH_LOW)
  39. p.init()
  40. time.sleep_ms(200)
  41. p.deinit()
  42. def right(self):
  43. p = PWM(0, self.pin, freq=PWM.FREQ_125KHZ, pulse_width=275, period=2500, mode=PWM.MODE_HIGH_LOW)
  44. p.init()
  45. time.sleep_ms(200)
  46. p.deinit()