changes in Tim's wheel walking library made during the WW slope campaign in ESTEC. Fixing bugs and adding offset speed functionality