added home position height offset and speed parameter