libraries refactored, and main robot code updated.