Still working on physics calculations, the r_squared is making problems.