5.4.1 关节空间容错构型群组求解