Some fixes in kulgur1_teleop. Still not tested.
kulgur1_teleop tested and working