数学�Uの点と直線の問題なんだが

問、2点A(4.-1)、B(0.5)から等距離にあり、
x座標とy座標が等しい点Pの座標を求めよ

解、
P点のx座標とy座標が等しいので、(p,p)とする。
APの距離は、√{(p−4)^2+(p+1)^2}
BPの距離は、√{p^2+(p−5)^2}
AP=BPより、
√{(p−4)^2+(p+1)^2}=√{p^2+(p−5)^2}
(p−4)^2+(p+1)^2=p^2+(p−5)^2
2p^2−6p+17=2p^2−10p+25
p=2
よって、点Pは、(2,2)となる。

これで合ってる?
これ複雑すぎて嫌なんだが
もっと簡単に出来たらなぁ・・