Merge pull request #3 from utiasASRL/feat/omp-speedups

OpenMP Speedups
Merge pull request #5 from utiasASRL/feat/travis-ci-backport

Travis CI Automated build tests
Merge remote-tracking branch 'upstream/master' into develop