Create Calculate twist function
rickstaa opened this issue · 1 comments
rickstaa commented
For the get_obs() function I need a way to calculate the velocity. For now, I will use a simple discrete differentiation to do this. Later I can transform this into a small Twist calculation function (see the tf implemention for an example).