Optimization Algorithm of Control Points Planning of Archwire Bending Forming