Real-Time Physics Simulation Forum

Re: Simple model not working, please help

2021-09-08T20:49:34+00:00

Since torque control of the motor is not working, as a workaround I can calculate the expected acceleration from the torque, integrate for the velocity, and use velocity control of the rotor. I am using this in another application (not the one I posted above), where I calculate the torque from aerodynamic forces, including lift and drag. This works, and the rotor reaches a terminal velocity of about 290 RPM where the torque drops to zero, which is what I would expect. However, in this condition getJointState() reports an applied torque of about 1 N. Why is this needed for a constant velocity?

Statistics: Posted by allan — Wed Sep 08, 2021 8:49 pm

Re: Simple model not working, please help

2021-09-08T18:16:14+00:00

Problem partly solved. I had not used the URDF_USE_INERTIA_FROM_FILE flag in loadURDF, so PyBullet was defaulting to an inertia tensor of zero. When I included the flag, I got an error message "Bad inertia tensor properties, setting inertia to zero for link", apparently because in my URDF model Izz was larger than the sum of Ixx and Iyy. Fixed that and now the rotor starts accelerating correctly, but as the velocity increases the acceleration gradually decreases and eventually reaches zero, although the applied torque remains the same. Joint damping and friction are both reported as zero.

Statistics: Posted by allan — Wed Sep 08, 2021 6:16 pm

Simple model not working, please help

2021-09-07T01:50:37+00:00

I have created an extremely simple model of a rotor rotating around the z-axis. The base link is a heavy rectangular box, the rotor is a single link representing two opposing rotor blades, and there is a continuous joint with a vertical axis between the links. When I use velocity control of the joint motor, calculating the acceleration and velocity myself based on the applied torque, it works nicely. When I use torque control for the motor, the results seem ridiculous. With a moment of inertia of 0.1512 and an applied torque of 0.0001 Nm, starting from rest, the initial angular acceleration is 150 radians/s^2. This decreases over the first 0.22 seconds to 113 rad/s^2. Then I reverse the torque, resulting in an initial acceleration of -187 rad/s^2, gradually decreasing to -112 rad/s^2 over the next 0.4 seconds. Obviously I must be doing something wrong, but what?

Here is the code:

Code:

# disable default velocity control of rotor hub jointp.setJointMotorControl2(gyro, rotor_joint_index,                     controlMode=p.VELOCITY_CONTROL, force=0)# set maximum velocity of joint                              p.changeDynamics(gyro, rotor_joint_index, maxJointVelocity=1000)#initialize simulation stateistep = 0dt = 1.0/250.0    # time step = 4 msp.setTimeStep(dt) torque = 0.0001   last_v = 0while True:    info = p.getJointState(gyro, rotor_joint_index)    v = info[1] # angular velocity from bullet    dv = v - last_v    a = dv/dt     last_v = v    rpm = v*60/(2*math.pi)    # rpm from angular velocity    print("time=%.3f(s)," % (istep*dt), "applied torque=%8.5f(Nm)," % (torque), \            "v=%7.3f(rad/s)" % (v), "a=%9.3f(rad/s^2)" % (a))    if v > 30:      torque = -0.0001    elif v < -30:      torque = 0.0001    p.setJointMotorControl2(gyro, rotor_joint_index,                                controlMode=p.TORQUE_CONTROL,                                 force=torque)    p.stepSimulation()    istep = istep + 1    sleep(1/10)

Here is my URDF model:

Code:

Any help would be appreciated. Thx.

Statistics: Posted by allan — Tue Sep 07, 2021 1:50 am