Add kinematics, restructure wb_space
New vector API for streamlining kinematic calculations

vector_adds/subs: Add/Subtract scaled vector. These are just macros
which hopefully expand into cache-friendly code.
More physics updates. Add bulk_kinematic_sim test