def simSleepTwentyHz(duration):
i = 0
[status, framesize] = t.get(tim, wait=True, last=True)
next = tim.sim[0] + 0.05
while i < duration:
[status, framesize] = t.get(tim, wait=True, last=True)
while tim.sim[0] < next:
[status, framesize] = t.get(tim, wait=True, last=True)
if status == ach.ACH_OK or status == ach.ACH_MISSED_FRAME or status == ach.ACH_STALE_FRAMES:
pass
else:
raise ach.AchException(v.result_string(status))
next = tim.sim[0] + 0.05
[status, framesize] = t.get(tim, wait=True, last=True)
i += 1
print '========== Daniel M. Lofaro ==========' print '========= [email protected] ==========' print '======================================' while True: # Get Frame img = np.zeros((newx,newy,3), np.uint8) c_image = img.copy() vid = cv2.resize(c_image,(newx,newy)) [status, framesize] = v.get(vid, wait=False, last=True) if status == ach.ACH_OK or status == ach.ACH_MISSED_FRAME or status == ach.ACH_STALE_FRAMES: vid2 = cv2.resize(vid,(nx,ny)) img = cv2.cvtColor(vid2,cv2.COLOR_BGR2RGB) cv2.imshow("wctrl", img) cv2.waitKey(10) else: raise ach.AchException( v.result_string(status) ) [status, framesize] = t.get(tim, wait=False, last=True) if status == ach.ACH_OK or status == ach.ACH_MISSED_FRAME or status == ach.ACH_STALE_FRAMES: pass #print 'Sim Time = ', tim.sim[0] else: raise ach.AchException( v.result_string(status) ) #----------------------------------------------------- #--------[ Do not edit above ]------------------------ #----------------------------------------------------- # Def: # ref.ref[0] = Right Wheel Velos # ref.ref[1] = Left Wheel Velos
