added torque calculation
added shape in system
added function angle for inline angle changes
added constexpr for optimisations
added contact points in collision response (not used yet)
no need for O3