Follow-up from "Add TEB to CMake config"

The following discussion from !27 (merged) should be addressed:

• @groegerto started a discussion:

  teb.poses().size is one larger than teb.timediffs().size()