Logic and animation done. Values still hardcoded

Main animation and equation solving complete. Still some problems. Might
need to find better equations.