说明：  This program has exceeded the performance of other algorithms, Based on piecewise nonlinear weight value Pso algorithm, Including quaternion various calculations.