New implementation and re-factoring of code

Physics improvements, type safe Lambda Callback implementations + some
other minor improvements