Refactored HelperFunctions to take coordiantes. Added foundation for safe movements.