Как получить возвращаемое значение в реальном времени из потока бесконечного цикла в Python 3 - PullRequest
0 голосов
/ 12 марта 2019

Я пытаюсь создать поток, который постоянно считывает данные с датчиков моего робота, чтобы я мог использовать расчетное значение «рулевого управления» в различных случаях запуска для двигателей, чтобы иметь возможность вовремя запускать двигатели на оборотах,и т. д. Я обнаружил нечто подобное ( Python, возвращающий значения из потока бесконечного цикла ), но это не помогло, поскольку оно печатало значения только когда я прерывал цикл (то есть: отключал датчик).Вот мой код:

from sensor_and_motor_startup import *
import threading
import queue

DEFAULT_SPEED = 60

# PID Values --These are subjective and need to be tuned to the robot and mat
# Kp must be augmented or decreased until the robot follows the line smoothly --Higher Kp = Stronger corrections
# Same with Ki, after Kp is done --- note, Ki is not used in this case (error accumulation)
# Kd to 1, and move up or done until smooth, after Kp and Ki
# This process can take a VERY long time to fine-tune
K_PROPORTIONAL = 0.2
K_INTEGRAL = 0
K_DERIVATIVE = 0


class OneSensorLineFollower:
    target = 24
    error = 0
    last_error = 0
    derivative = 0
    integral = 0

    def __init__(self, color_sensor):
        self.__color_sensor = color_sensor

    def follower(self, side_of_line=None, kp=K_PROPORTIONAL):
        if side_of_line is None:
            side_of_line = self.SideOfLine.left
        else:
            side_of_line = self.SideOfLine.right
        self.error = self.target - (self.__color_sensor.value(3) / 2)
        self.integral = self.error + self.integral
        self.derivative = self.error - self.last_error
        motor_steering = ((self.error * kp) + (self.integral * K_INTEGRAL) + (self.derivative * K_DERIVATIVE
                                                                                          )) * float(side_of_line)
        self.last_error = self.error
        return motor_steering

    class SideOfLine:
        left = 1
        right = -1


def hisp_center_corrector(out_que):
    while True:
        follow = OneSensorLineFollower(left_side_sensor)
        steering = follow.follower(kp=0.15)
        out_que.put(steering)
        sleep(0.1)


def low_speed_follower(speed=DEFAULT_SPEED, rotations=5):
    follower = OneSensorLineFollower(center_sensor)
    steer_pair.on_for_rotations(follower.follower(kp=0.3), speed, rotations)


que = queue.Queue()
t = threading.Thread(target=hisp_center_corrector, args=(que,))
t.start()
t.join()
while True:
    value = que.get()
    print(value)

1 Ответ

1 голос
/ 12 марта 2019

Вы звоните .join(), что заставляет ваш главный поток ждать завершения этого потока.

Начните свой поток как дэймон и не присоединяйтесь к нему:

threading.Thread(target=hisp_center_corrector, args=(que,), daemon=True).start()

В противном случае ваш value = que.get() код не будет работать.

...