Kinematics restructuring started

Performance improvements in KinematicInvariants
Base class for kinematic variables started