Call the initialize function from within test

Use an seperate intialization function and don't override the setUp
function from UnitTest to make sure test test fails if an error occurs
while initializing. This is not the case when using setUp
Fix type, use proper variable instead of function
Rename to simple_two_point
Set the table's mass to 0.1
Include a light table with a mass of 0.01
Include two new test scenarios with a table collision

The first test contains a heavier table wich the robot is not able to
move. The test fails consequently. The second one can be moved and the
test succeeds.
Code refactoring
Checki f the navigation reached the target goal
Rename package to navigation_test_sample
Fix wrong package names
Move rosbag patcher to new analysis directory
Include timeout handling