Add sliding forces/torques to Contact
Fix I/G initialization, calculate E_omega
Simple example to (maybe/hopefully) test rolling of contacts