关节角度用sin/cos对表示可消除角度周期性不连续的问题（如359°和1°数值差异大但物理上相近）