Fixed some physics bugs and cleaned up use std:: lines