Good Thomas Algorithm