debug UF controller (is working!) 
added general circular trajectory