Pulled stage movement routine into main

Including:
- homing
- image capture
- default position following shear
- package placement

TODO: determine necessary coordinates for these actions and set them in
main.