对比分析了伪逆法和最优能量算法的原理，给出了最优能量算法的优化方案。笛卡尔空间体系中采用齐次矩阵和四元数法获得位置和姿态的插值；利用优化后的最优能量算法求出逆解，得到与笛卡尔空间中对应的在关节空间中的关节值。文中给出了实际仿真实例，该实例表明本文给出的优化方案在满足正常作业情况下，相对于伪逆法，方案中四元数算法在姿态插值运算上更快并且能量优化效果更好，七轴机械手最小能量消耗节约10%~20%左右。