Raspberry Piでサーボモータの制御を行うことを考えているのですが、サーボモータが途中で動作しなくなります。
Raspberry PiはArduinoとUSBで接続され、シリアル通信を行います。Arduino
側にはポテンショメータを接続し、この角度のデータをraspberry piに送ります。
Raspberry piのメインループでは常時この角度データを受け取り、ターミナル上に表示しています。
そしてスイッチが押された時に、割り込み処理としてサーボモータを動作させることを考えています。
現状としては、プログラム実行後に1度スイッチを押すと割り込みを行い、サーボモータが目標角度に回転してくれるのですが、2度目以降は少し反応があるだけで、回転はしません。この問題の解決方法が知りたいです。
ちなみに割り込みは立下りに対して行うように設定しました。
python
1#-*-coding:utf-8 -*- 2import time 3import RPi.GPIO as GPIO 4import serial 5import csv 6 7f = open('data.csv','ab') 8ser = serial.Serial('/dev/ttyACM0', 9600) 9 10csvWriter = csv.writer(f) 11 12GPIO.setmode(GPIO.BCM) 13gp_out1 = 17 14GPIO_SW = 22 15delay = 0.01 16 17def callback_event(GPIO_SW): 18 time.sleep(0.05) 19 20 servo1.start(2.5) 21 22 time.sleep(0.5) 23 servo1.ChangeDutyCycle(12.0) 24 25 time.sleep(0.5) 26 servo1.ChangeDutyCycle(2.5) 27 28 servo1.stop() 29 30GPIO.setup(GPIO_SW, GPIO.IN, pull_up_down = GPIO.PUD_UP) 31GPIO.setup(gp_out1, GPIO.OUT) 32servo1 = GPIO.PWM(gp_out1, 50) 33 34GPIO.add_event_detect(GPIO_SW, GPIO.BOTH) 35GPIO.add_event_callback(GPIO_SW, callback_event) 36 37val = 0 38 39try: 40 while True: 41 listData = [] 42 val = val+1 43 ang = ser.readline() 44 listData.append(ang) 45 csvWriter.writerow(listData) 46 print(ang) 47 48except KeyboardInterrupt: 49 print("\nbreak") 50 GPIO.remove_event_detect(22) 51 GPIO.cleanup() 52 53f.close()
バッドをするには、ログインかつ
こちらの条件を満たす必要があります。