Fixed floating point comparaison
More work done on physics module