add cyclic motion trj simulator, it works quite good