Progressing on arms.
Handles robot coordinates correctly.
Added some simple sanity test for position manager.
Handles the table coordinate correctly.
Fix a bug with date past trajectory end.

Before this fix, evaluating the last point of the trajectory was always
evaluated in arm frame.
Extracted out part of arm_position_for_date.