Fixed moveDiag and added goTo