Fix diagonal movement step cost