Finalized Physics Engine and added Doxygen Comments