Position choice working. Added debug and cleanup

Debug will eventually be moved to a global cmd_Debug_Functions file in
the root folder.