[GRASPth] Storing previous contact value to solve #1. This has to be tested.
Merging master into BufferiseSkinPort-#1.
[GRASPth] Fixing joint map creation, velocities setting procedures and skin port bufferisation (#1).