ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

Issue with multithreading and standard output

asked 2014-02-10 09:27:06 -0500

rse101 gravatar image

updated 2016-10-24 08:35:50 -0500

ngrennan gravatar image

I have a multithreaded piece of python code that moves the arms of my robot. The basic premise is that there is one thread for each arm, and threads block until each arm as finished it's movements (i.e., given two sets of joint positions, one for each arm, the program splits into two threads that loop until their respective arm has reached the specified joint positions). Here is the code that does that:

def __moveToJointPos(self, instance, index): if instance >= self.numInstances(): raise Exception("Called with instance " + str(instance) + " but only " + str(self.numInstances()) + " instances exist")

    t = None
    if type(index) is tuple:
        #If this method is being called with 2 indices rather than one, that means we want to move both arms at the same time.
        #To do this, we spin off one of the indices to another thread, then execute as normal on the remaining one.
        #Then we wait until the other thread finishes before returning.
        if len(index) > 2:
            raise Exception("Can only call with a tuple of size 2, got a tuple of size " + str(len(index)))
        elif self.poss[instance][1][index[0]][0] == self.poss[instance][1][index[1]][0]:
            raise Exception("When calling with a tuple, must specify indices with different arms.")
        elif len(index) == 2:
            i2 = index[1]
            t = threading.Thread(target=self._Behavior__moveToJointPos, args = (instance, i2))
            t.daemon = True
        mov = self.poss[instance][1][index[0]]
        mov = self.poss[instance][1][index]

    rate = rospy.Rate(10)

    if mov[0] == Behavior.RIGHT_ARM:
        arm = self.right_arm
        arm = self.left_arm
    done = False
    dd = [9999.0, 9999.0, 9999.0, 9999.0, 9999.0]
    while not done:
        dist = 0.0
        for j in arm.joint_names():
            dist = dist + (mov[1][j] - arm.joint_angle(j))*(mov[1][j] - arm.joint_angle(j))
        dist = math.sqrt(dist)
        ss = 0.0
        for d in dd:
            ss = ss + math.fabs(d - dist)
        if ss < 0.01:
            done = True
        elif rospy.is_shutdown():
            print("ROS shutdown, cancelled movement")
            done = True
        if baxter_external_devices.getch() in ['\x1b', '\x03']:
            done = True
            del dd[0]

    if t is not None:

I'll admit the code is rather messy, but this is just something I'm quickly hacking together to test out the robot. Here is the code that calls that function:

        self._Behavior__moveToJointPos(0,(ToTable.lHOME, ToTable.rHOME))
        self._Behavior__moveToJointPos(0,(ToTable.lMID, ToTable.rMID))
        self._Behavior__moveToJointPos(0,(ToTable.lTABLE, ToTable.rTABLE))

(the prints are added so that the effect on standard out is more clear). Here is what my terminal looks like:

Here is the link to the image:

(you may need to open it in a separate tab to see it). There are a couple more calls to __moveToJointPos, which is why there is more text output, but the error starts with the set of commands above. As you can see ... (more)

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2014-02-10 10:23:17 -0500

ahendrix gravatar image

It looks like you're accidentally sending some kind of control code to the terminal subsystem that's disabling the local echo and carriage returns.

For starters, you should be able to reset your terminal to the default state with the stty sane command (hit enter, type and pray).

Beyond that, I would inspect your program's print statements for stray escape sequences that could be causing this. If you don't find anything obvious there, you could try piping the output through something like hexdump to decode all of the console output before is passes into the pseudo-tty layer and messes things up.

Go read "Advanced Programming in the UNIX Environment" or another similar UNIX systems programming book for more details of the underlying mechanics here.

edit flag offensive delete link more


Thanks for the help. stty sane worked beautifully. I don't really have time at the moment to parse through the output and figure out exactly what is happening, so for the moment I just hacked it and added 'call(["stty", "sane"])' in the last if block right after 't.join()'. It works for now, I'll fix it later. Thanks again!

rse101 gravatar image rse101  ( 2014-02-11 07:25:35 -0500 )edit

Question Tools


Asked: 2014-02-10 09:27:06 -0500

Seen: 368 times

Last updated: Feb 10 '14