fixed indexing bug
Merge branch 'pcmoritz' of https://github.com/pcmoritz/bulletsim into pcmoritz