请用python写树莓派4b的舵机控制
时间: 2023-07-19 10:05:43 浏览: 104
首先,你需要连接树莓派4b和舵机。舵机的信号线需要连接到树莓派的GPIO引脚。
然后,你需要安装RPi.GPIO库,这个库可以让你在树莓派上控制GPIO引脚。
下面是一个简单的Python程序,用于控制舵机的角度:
```python
import RPi.GPIO as GPIO
import time
# 设置GPIO模式
GPIO.setmode(GPIO.BCM)
# 设置舵机连接的GPIO引脚号
servo_pin = 18
# 设置舵机的频率和占空比
freq = 50
duty_cycle_min = 2.5
duty_cycle_max = 12.5
# 初始化舵机
GPIO.setup(servo_pin, GPIO.OUT)
pwm = GPIO.PWM(servo_pin, freq)
pwm.start(0)
# 控制舵机旋转到指定角度
def set_angle(angle):
duty_cycle = ((angle / 180) * (duty_cycle_max - duty_cycle_min)) + duty_cycle_min
pwm.ChangeDutyCycle(duty_cycle)
time.sleep(0.5)
try:
while True:
set_angle(0) # 舵机旋转到0度
set_angle(90) # 舵机旋转到90度
set_angle(180) # 舵机旋转到180度
except KeyboardInterrupt:
pwm.stop()
GPIO.cleanup()
```
该程序会让舵机旋转到0度、90度和180度,然后循环执行。你可以根据自己的需要修改程序,控制舵机旋转到任意角度。