Total Mechanical Energy Formula