Restructure functions to core/
Move utility functions to utils/ folder and create associated __init__.py file
Test files for core navpy and utilities.