worked a bit on this

just added RRTAlgorithm as empty lib and TMotion including data
structures for motions we need.
I'll continue implementing this in the next days