Modify stabbing logic, closes #52
Merge branch 'bugfix/stabReach' into develop