Refactored main control logic into hp3dx2
Added robot init
Merge branch 'master' of github.com:sjwaller/hp3dx2_robot

Conflicts:
	src/hp3dx2.cpp
	src/hp3dx2.h