Finished a basic interface to communicate with XY stage