树莓派小车pid控制_树莓派控制小车(1)

这篇博客介绍了如何使用Python和RPi.GPIO库来控制树莓派小车的前进、后退、右转和左转。通过设置GPIO引脚的高低电平,实现了小车的基本运动控制。代码中还包含了信号处理函数,用于在程序异常退出时清理GPIO资源。
摘要由CSDN通过智能技术生成

importRPi.GPIO as GPIOimporttimeimportsignal'''gpio_init()

forward()

go_back()

right()

left()

gpio_uninit()'''INT1= 5INT2= 6INT3= 13INT4= 19GPIO.setwarnings(False)defsig_handler(sig, frame):try:

gpio_uninit()exceptException, ex:

exit(0)defsetup():try:

GPIO.setmode(GPIO.BCM)

GPIO.setup(INT1, GPIO.OUT)

GPIO.setup(INT2, GPIO.OUT)

GPIO.setup(INT3, GPIO.OUT)

GPIO.setup(INT4, GPIO.OUT)exceptException, ex:

gpio_uninit()

exit(0)defforward():try:

GPIO.output(INT1, GPIO.HIGH)

GPIO.output(INT2, GPIO.LOW)

GPIO.output(INT3, GPIO.LOW)

GPIO.output(INT4, GPIO.HIGH)exceptException, ex:

gpio_uninit()

exit(0)defgo_back():try:

GPIO.output(INT1, GPIO.LOW)

GPIO.output(INT2, GPIO.HIGH)

GPIO.output(INT3, GPIO.HIGH)

GPIO.output(INT4, GPIO.LOW)exceptException, ex:

gpio_uninit()

exit(0)defright():try:

GPIO.output(INT1, GPIO.HIGH)

GPIO.output(INT2, GPIO.LOW)

GPIO.output(INT3, GPIO.HIGH)

GPIO.output(INT4, GPIO.LOW)exceptException, ex:

gpio_uninit()

exit(0)defleft():try:

GPIO.output(INT1, GPIO.LOW)

GPIO.output(INT2, GPIO.HIGH)

GPIO.output(INT3, GPIO.LOW)

GPIO.output(INT4, GPIO.HIGH)exceptException, ex:

gpio_uninit()

exit(0)defgpio_init():try:

setup()

signal.signal(signal.SIGTERM, sig_handler)

signal.signal(signal.SIGINT, sig_handler)exceptException, ex:

gpio_uninit()

exit(0)defgpio_uninit():

GPIO.cleanup()if __name__ == '__main__':try:

gpio_init()

forward()

go_back()

right()

left()

gpio_uninit()exceptException, ex:

gpio_uninit()

  • 0
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值