Toolbox for (serial manipulator) robotics, focusing robot dynamics