Fixed a critical bug related to turning and cost calculation. Cleaned up
constructors.