Grasp initialization and stabilization

Summary
Report and software concerning the respective algorithms of RAMCIP