【发布时间】:2026-02-19 03:25:02
【问题描述】:
我有一个名为 inverseJ 的矩阵,它是一个 2x2 矩阵 ([[0.07908312, 0.03071918], [-0.12699082, -0.0296126]]),以及一个长度为 2 ([-31.44630082, -16.9922145]) 的一维向量 deltaT。在 NumPy 中,将它们相乘应该再次产生一个一维向量,如this example。但是,当我使用 inverseJ.dot(deltaT) 将它们相乘时,我得到一个二维数组 ([[-3.00885838, 4.49657509]]),其中唯一的元素是我实际要查找的向量。有谁知道为什么我不简单地得到一个向量?非常感谢任何帮助!
整个脚本供参考
from __future__ import division
import sys
import io
import os
from math import *
import numpy as np
if __name__ == "__main__":
# Fingertip position
x = float(sys.argv[1])
y = float(sys.argv[2])
# Initial guesses
q = np.array([0., 0.])
q[0] = float(sys.argv[3])
q[1] = float(sys.argv[4])
error = 0.01
while(error > 0.001):
# Configuration matrix
T = np.array([17.3*cos(q[0] + (5/3)*q[1])+25.7*cos(q[0] + q[1])+41.4*cos(q[0]),
17.3*sin(q[0] + (5/3)*q[1])+25.7*sin(q[0] + q[1])+41.4*sin(q[0])])
# Deviation
deltaT = np.subtract(np.array([x,y]), T)
error = deltaT[0]**2 + deltaT[1]**2
# Jacobian
J = np.matrix([ [-25.7*sin(q[0]+q[1])-17.3*sin(q[0]+(5/3)*q[1])-41.4*sin(q[0]), -25.7*sin(q[0]+q[1])-28.8333*sin(q[0]+(5/3)*q[1])],
[25.7*cos(q[0]+q[1])+17.3*cos(q[0]+(5/3)*q[1])+41.4*cos(q[0]), 25.7*cos(q[0]+q[1])+28.8333*cos(q[0]+(5/3)*q[1])]])
#Inverse of the Jacobian
det = J.item((0,0))*J.item((1,1)) - J.item((0,1))*J.item((1,0))
inverseJ = 1/det * np.matrix([ [J.item((1,1)), -J.item((0,1))],
[-J.item((1,0)), J.item((0,0))]])
### THE PROBLEMATIC MATRIX VECTOR MULTIPLICATION IN QUESTION
q = q + inverseJ.dot(deltaT)
【问题讨论】:
标签: python python-3.x numpy vector matrix-multiplication