Used SimTK::UnitVec3 to normalize directions
Make sure test wouldn't pass bc accs are set zero accidentally
Added non-zero acc check to all tests using acc-check