问vpython中齿轮对象的偏航旋转

EN

# https://www.youtube.com/watch?v=0Sw8sxsN984
# https://www.youtube.com/watch?v=MJiVtz4Uj7M

from vpython import *
import numpy as np

axisOpac = 0.4

def makeAxes(length):
    
    global axes

    xaxis = arrow(pos=vector(0, 0, 0), axis=length*vector(1,0,0), shaftwidth = 0.1*(length), color=color.red, opacity = axisOpac)
    negXaxis = xaxis.clone()
    negXaxis.axis *= -1

    yaxis = arrow(pos=vector(0, 0, 0), axis=length*vector(0,1,0), color=color.green, opacity = axisOpac)
    negYaxis = yaxis.clone()
    negYaxis.axis *= -1

    zaxis = arrow(pos=vector(0, 0, 0), axis=length*vector(0,0,1), color=color.magenta, opacity = axisOpac)
    negZaxis = zaxis.clone()
    negZaxis.axis *= -1    

    fudge = 0.01*length
    xlabel = label(text = "x", color = xaxis.color, pos=xaxis.axis+vector(0, fudge, 0),box = False)
    ylabel = label(text = "y", color = yaxis.color, pos=yaxis.axis+vector(0, fudge, 0),box = False)
    zlabel = label(text = "-z", color = zaxis.color, pos=zaxis.axis+vector(0, fudge, 0),box = False)
    
    # To make axes visible or invisible
    axes = [xaxis, negXaxis, yaxis, negYaxis, zaxis, negZaxis, xlabel, ylabel, zlabel]

    return

makeAxes(1)

g = shapes.gear(n = 20)

gear1 = extrusion (path = [vector(0, 0, 0), vector(0, 0, 0.1)], shape=g, opacity = 0.4)
# gear1.axis = vector(0, 0, 0)

debugArrow=arrow(length=6,shaftwidth=.1,color=color.white,axis=vector(0,0,0))
gearAxisArrow=arrow(shaftwidth=.1, color=color.red)

inputYawAngleYaxis = 0 # int(input("Enter an angle: "))

while True:
    for cir in np.arange(0, 2*np.pi, 0.01):
        rate(10)
        # sleep(1)

        pitch=0
        # k = vector(cos(yaw)*cos(pitch), sin(pitch),sin(yaw)*cos(pitch))  ''' with pitch input '''
        k = vector(cos(cir), 0 ,sin(cir))  # ''' without pitch input '''
        y=vector(0,0,0)
        s=cross(k,y)
        v=cross(s,k)



        rad = radians(45)
        # gear1.axis = vector(1.23, -1.77418, 0) #vector(cos(inputYawAngleYaxis * pi/180), sin(pitch),sin(inputYawAngleYaxis* pi/180)*cos(pitch))
        # gear1.pos = vector(-2.94957, 0, 2.70185)
        
        # Gear Pos0:  <0.707107, 0, 0.707107>  Gear Axis0:  <2.15647, 0.101243, -0.00237659>
        gear1.pos = vector(0.707107, 0, 0.707107)
        # gear1.pos =  debugArrow.axis #frontArrow.axis # k # vector(0.707107, 0, 0.707107)
        gear1.rotate(angle = -0.1, axis = vector(0, 0, 1), origin = vector(0, 0, 1 ))
        # gear1.axis = vector(cos(radians(-45)), 0, sin(radians(-45))) 

        ''' DebugArrow represents the position of the gear's center '''
        debugArrow.axis = vector(cos(rad), 0, sin(rad))


        ''' Arrow inside the gear to track rotational axis of gear - This is to debug the yaw issue facing with gear object'''
        gearAxisArrow.pos = gear1.pos
        gearAxisArrow.axis = gear1.axis # vector(cos(radians(-45)), 0, sin(radians(-45))) # gear1.axis
        gearAxisArrow.length = gear1.length/2
        
            ## Debugg 
        # print("Front Arrow Axis: ", frontArrow.axis, " K vec: ", k, " Ball pos: ", ball.pos )
        print("Gear Pos0: ", gear1.pos, " Gear Axis0: ", gear1.axis, "gearAxisArrow: ", gearAxisArrow.pos, "gearAxisArrow: ", gearAxisArrow.axis)