Experimented with limit switch settings and modified the while loop on get position to look for limit error
Added a Origin member variable to Config class
Added the set limit commands to test