public void writeFrame(
String frameName, double X, double Y, double Z, double A, double B, double C) {
KRLFrame frame = new KRLFrame(frameName);
frame.setX(X);
frame.setY(Y);
frame.setZ(Z);
frame.setA(A);
frame.setB(B);
frame.setC(C);
try {
this.connection.writeVariable(frame);
} catch (Exception e) {
System.out.println("Error writing frame to Robot");
}
}
