Added debug drawing for bullet and fixed physics issue