天天看点

树莓派控制多个舵机_树莓派控制SG90舵机

树莓派控制多个舵机_树莓派控制SG90舵机
SG90舵机 硬件接口:

SG90 一共三根线,红线接5v电源,棕线GND,黄线为数据控制线,接到GPIO上

舵机参数:

SG90 脉冲周期为20ms,脉宽0.5ms-2.5ms对应的角度-90到+90,对应的占空比为2.5%-12。

python脚本

import RPi.GPIO as GPIO

import time

import signal

import atexit

atexit.register(GPIO.cleanup)

servopin = 7

GPIO.setmode(GPIO.BOARD)

GPIO.setup(servopin, GPIO.OUT, initial=False)

p = GPIO.PWM(servopin, 50) # 50HZ

p.start(0)

time.sleep(2)

i = input("num:")

i = int(i)

while (True):

p.ChangeDutyCycle(0) # 初始化

time.sleep(0.4)

b = input("输入角度:")

b = int(b)

c = b/18+2.5 # 计算占空比

p.ChangeDutyCycle(c) # 设置转动角度

time.sleep(0.4)

p.stop()

GPIO.cleanup()