python香橙派wiringpi库控制舵机

原创

已于 2024-03-24 21:19:01 修改 · 1.1k 阅读

10 ·

CC 4.0 BY-SA版权

文章标签：

#python #开发语言 #ubuntu #嵌入式硬件

于 2024-03-24 21:12:13 首次发布

本文详细介绍了如何在香橙派3b上通过wiringpi库实现0-180度角度控制的软件PWM，包括引脚映射、函数定义和主程序操作。

我使用的是香橙派3b

使用前安装wiringpi库

引脚映射关系：

所以代码18，连的是派的28号引脚

这个是软件控制pwm：

import wiringpi
#0-180度的代码，用软件pwm
SERVO_PIN = 18
ANGLE_MIN = 0   
ANGLE_MAX = 180 

SERVO_MIN_PWM = 5   
SERVO_MAX_PWM = 25  

def map_angle_to_pwm(angle):
    return SERVO_MIN_PWM + (angle - ANGLE_MIN) * (SERVO_MAX_PWM - SERVO_MIN_PWM) // (ANGLE_MAX - ANGLE_MIN)

def main():
    print("Servo Control Program")

    if wiringpi.wiringPiSetup() == -1:
        print("Failed to initialize wiringPi")
        exit(1)

    wiringpi.softPwmCreate(SERVO_PIN, 0, SERVO_MAX_PWM) 

    while True:
        for angle in range(ANGLE_MIN, ANGLE_MAX + 1):
            pwm_value = map_angle_to_pwm(angle)
            wiringpi.softPwmWrite(SERVO_PIN, pwm_value)
            wiringpi.delay(15) 

        for angle in range(ANGLE_MAX, ANG