Add more meaningful planner tests

[kirstyellis]

Currently the test for the planner plans a movement of the hand/arm through different positions and reports for each planner if it succeeds. Sometimes a plan fails and sometimes not, it is unpredictable. The test should be adapted to output more meaningful information about each planner, possible presented in a table, maybe with a graph?