Added module for simple homing
CHanged define in sot_VelKinCon_test