Hokuyo update from bot
fix missing semaphore wait, ignore kinematics more often, print return value in debug file