Add initial code of agent
Initial move message implementation

Controller will only send one axis command at time.