tp cost use distance squared // fix float -> int
tp cost use distance squared // fix float -> int