IROS fastslow version 1