public PositionedElement getElement(Body skeleton) {
ListIterator<Method> iter = Arrays.asList(skeleton.getClass().getMethods()).listIterator();
while (iter.hasNext()) {
Method method = iter.next();
if (method.getReturnType().equals(test)) {
try {
return (PositionedElement) method.invoke(skeleton, new Object[0]);
} catch (IllegalAccessException | IllegalArgumentException | InvocationTargetException e) {
e.printStackTrace();
}
}
}
return null;
}
public void printLeftHandPosition() throws InterruptedException {
KinectManager.INSTANCE.startKinect();
KinectManager.INSTANCE.startSkeletonTracking();
// System.out.println("avant boucle") ;
float Aarbis = 400; // au delà de 360 pour etre sur que Aarbis différent
// de AAr au départ
while (isAlive) { // en attendant que l'on trouve une solution pour
// changer isALive en false. A priori bouton
// eclipse.
Body body = KinectManager.INSTANCE.getSkeletonModel();
float Xrh = (float) body.getRightHand().getX();
float Yrh = (float) body.getRightHand().getY();
float Xlh = (float) body.getLeftHand().getX();
float Ylh = (float) body.getLeftHand().getY();
float Xch = (float) body.getCenterHip().getX();
float Ych = (float) body.getCenterHip().getY();
float Xrs = (float) body.getRightShoulder().getX();
float Yrs = (float) body.getRightShoulder().getY();
float Xls = (float) body.getLeftShoulder().getX();
float Yls = (float) body.getRightShoulder().getY();
/*
* if (body.getHead().getX()==0){ i++;} else { i=0;} if (i==2000){
* isAlive=false; }
*/
float produitScalaire = (Xrh - Xrs) * (Xlh - Xls) + (Yrh - Yrs) * (Ylh - Yls);
float normeR = (float) Math.sqrt((Xrh - Xrs) * (Xrh - Xrs) + (Yrh - Yrs) * (Yrh - Yrs));
float normeL = (float) Math.sqrt((Xlh - Xls) * (Xlh - Xls) + (Ylh - Yls) * (Ylh - Yls));
float produitNorme = normeR * normeL;
float Aar = (float) (Math.acos(produitScalaire / produitNorme) * 180 / Math.PI);
if (Aar != Aarbis && Ych != 0) {
Aarbis = Aar;
System.out.println(
"leftHand x: "
+ body.getLeftHand().getX()
+ "|leftHand y: "
+ body.getLeftHand().getY()
+ "|leftHand z: "
+ body.getLeftHand().getZ()
+ "|rightHand x: "
+ body.getRightHand().getX()
+ "|rightHand y: "
+ body.getRightHand().getY()
+ "|rightHand z: "
+ body.getRightHand().getZ()
+ "|centerHip x: "
+ body.getCenterHip().getX()
+ "|centerHip y: "
+ body.getCenterHip().getY()
+ "|centerHip z: "
+ body.getCenterHip().getZ()
+ "|head x: "
+ body.getHead().getX()
+ "|Head y: "
+ body.getHead().getY()
+ "|head z: "
+ body.getHead().getZ()
+ "angle "
+ Aar);
System.out.println();
try {
pw.append(
"leftHand x: "
+ body.getLeftHand().getX()
+ " leftHand y: "
+ body.getLeftHand().getY()
+ " leftHand z: "
+ body.getLeftHand().getZ()
+ System.getProperty("line.separator")
+ "rightHand x: "
+ body.getRightHand().getX()
+ " rightHand y: "
+ body.getRightHand().getY()
+ " rightHand z: "
+ body.getRightHand().getZ()
+ System.getProperty("line.separator")
+ "centerHip x: "
+ body.getCenterHip().getX()
+ " centerHip y: "
+ body.getCenterHip().getY()
+ " centerHip z: "
+ body.getCenterHip().getZ()
+ System.getProperty("line.separator")
+ "head x: "
+ body.getHead().getX()
+ " Head y: "
+ body.getHead().getY()
+ " head z: "
+ body.getHead().getZ()
+ System.getProperty("line.separator")
+ "angle "
+ Aar
+ System.getProperty("line.separator")
+ System.getProperty("line.separator"));
pw.flush();
} catch (Exception e) {
// TODO Auto-generated catch block
e.printStackTrace();
// Thread.sleep(100);
}
}
}
KinectManager.INSTANCE.stopKinect();
}