Updated and testing basic functionality on Kuka