Added specs, Moved output functions last.
Small refactor of printPos.