Bug in velocity indexing

[vikashplus]

pddm/pddm/envs/baoding/baoding_env.py

Line 333 in 06b88cd

self.obs_dict['object2_velp'] = qv_obj[3+4:3+4+3]

Unlike Object positions which are 7D vectors represented as <x,y,z,q0,q1,q2,q3>, object velocities is 6D vectors represented as <x,y,z,rx,ry,rz>. I believe the correct way to get object's velocities are as below

        # object translational velocities
        self.obs_dict['object1_velp']    = qv_obj[:3]
        self.obs_dict['object2_velp']    = qv_obj[3+3:3+3+3]