private void updateRigidBodiesListeners(ArrayList<MocapRigidBody> listOfRigidbodies) { for (MocapRigidbodiesListener listener : listOfMocapRigidBodiesListeners) { listener.updateRigidbodies(listOfRigidbodies); } }
private void updateRigidBodiesListeners(ArrayList<MocapRigidBody> listOfRigidbodies) { for (MocapRigidbodiesListener listener : listOfMocapRigidBodiesListeners) { listener.updateRigidbodies(listOfRigidbodies); } }
protected void updateRigidBodiesListeners(ArrayList<MocapRigidBody> listOfRigidbodies) { frequency = callFrequencyCalculator.determineCallFrequency(); if (System.currentTimeMillis() - lastTime > 5000) { if (frequency < 95) // Should always be around 99 { System.err.println("**MOCAP WARNING** - Receiving data rate is less than 95Hz >>>> " + frequency); } } ArrayList<MocapRigidbodiesListener> list = (ArrayList<MocapRigidbodiesListener>) listOfMocapRigidBodiesListeners.clone(); for (MocapRigidbodiesListener listener : list) { listener.updateRigidbodies(listOfRigidbodies); } }
protected void updateRigidBodiesListeners(ArrayList<MocapRigidBody> listOfRigidbodies) { frequency = callFrequencyCalculator.determineCallFrequency(); if (System.currentTimeMillis() - lastTime > 5000) { if (frequency < 95) // Should always be around 99 { System.err.println("**MOCAP WARNING** - Receiving data rate is less than 95Hz >>>> " + frequency); } } ArrayList<MocapRigidbodiesListener> list = (ArrayList<MocapRigidbodiesListener>) listOfMocapRigidBodiesListeners.clone(); for (MocapRigidbodiesListener listener : list) { listener.updateRigidbodies(listOfRigidbodies); } }
public void updateRigidbodies(ArrayList<MocapRigidBody> listOfRigidbodies) { listOfConvertedRigidBodies = new ArrayList<>(); for (MocapRigidBody rb : listOfRigidbodies) { // if (rb.getId() == 1) // { rigidBodyInformationInMocapOrigin = new RigidBodyTransform(new Quaternion(rb.qx, rb.qy, rb.qz, rb.qw), new Vector3D(rb.xPosition, rb.yPosition, rb.zPosition)); mocapRB.update(); mocapRBZUp.update(); FramePose3D rigidBodyPoseInZUp = new FramePose3D(mocapRBZUp, new Point3D(0, 0, 0), new Quaternion()); rigidBodyPoseInZUp.changeFrame(ReferenceFrame.getWorldFrame()); final Vector3D position = new Vector3D(rigidBodyPoseInZUp.getPosition()); final Quaternion rotation = new Quaternion(rigidBodyPoseInZUp.getOrientation()); listOfConvertedRigidBodies.add(new MocapRigidBody(rb.getId(), position, rotation, null, true)); // } } for (MocapRigidbodiesListener listener : listOfMocapRigidBodiesListeners) { listener.updateRigidbodies(listOfConvertedRigidBodies); } } }
listener.updateRigidbodies(listOfConvertedRigidBodies);