ConfigurationData.java 3.0 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980
  1. package at.acdp.urweb.sclient.data;
  2. import at.acdp.urweb.CountDataInputStream;
  3. import java.io.DataInputStream;
  4. import java.io.IOException;
  5. import java.util.Arrays;
  6. public class ConfigurationData implements IRead, ILogentry {
  7. double[] jointMinLimit=new double[6];
  8. double[] jointMaxLimit=new double[6];
  9. double[] jointMaxSpeed=new double[6];
  10. double[] jointMaxAcceleration= new double[6];
  11. double vJointDefault;
  12. double aJointDefault;
  13. double vToolDefault;
  14. double aToolDefault;
  15. double eqRadius;
  16. double[] dha=new double[6];
  17. double[] dhd=new double[6];;
  18. double[] dhAlpha=new double[6];;
  19. double[] dhTheta=new double[6];;
  20. int masterboardVersion;
  21. int controllerBoxType;
  22. int robotType;
  23. int robotSubType;
  24. public void read(CountDataInputStream di, int size) throws IOException {
  25. for(int i=0; i<jointMinLimit.length; i++)
  26. jointMinLimit[i] = di.readDouble();
  27. for(int i=0; i<jointMaxAcceleration.length; i++)
  28. jointMaxAcceleration[i] = di.readDouble();
  29. for(int i=0; i<jointMaxSpeed.length; i++)
  30. jointMaxSpeed[i] = di.readDouble();
  31. for(int i=0; i<jointMaxAcceleration.length; i++)
  32. jointMaxAcceleration[i] = di.readDouble();
  33. vJointDefault = di.readDouble();
  34. aJointDefault = di.readDouble();
  35. vToolDefault = di.readDouble();
  36. aToolDefault = di.readDouble();
  37. eqRadius = di.readDouble();
  38. for(int i=0;i<dha.length;i++)
  39. dha[i] = di.readDouble();
  40. for(int i=0;i<dhd.length;i++)
  41. dhd[i] = di.readDouble();
  42. for(int i=0;i<dhAlpha.length;i++)
  43. dhAlpha[i] = di.readDouble();
  44. for(int i=0;i<dhTheta.length;i++)
  45. dhTheta[i] = di.readDouble();
  46. masterboardVersion = di.readInt();
  47. controllerBoxType = di.readInt();
  48. robotType = di.readInt();
  49. robotSubType = di.readInt();
  50. }
  51. @Override
  52. public String toString() {
  53. return "ConfigurationData{" +
  54. "jointMinLimit=" + Arrays.toString(jointMinLimit) +
  55. ", jointMaxLimit=" + Arrays.toString(jointMaxLimit) +
  56. ", jointMaxSpeed=" + Arrays.toString(jointMaxSpeed) +
  57. ", jointMaxAcceleration=" + Arrays.toString(jointMaxAcceleration) +
  58. ", vJointDefault=" + vJointDefault +
  59. ", aJointDefault=" + aJointDefault +
  60. ", vToolDefault=" + vToolDefault +
  61. ", aToolDefault=" + aToolDefault +
  62. ", eqRadius=" + eqRadius +
  63. ", dha=" + Arrays.toString(dha) +
  64. ", dhd=" + Arrays.toString(dhd) +
  65. ", dhAlpha=" + Arrays.toString(dhAlpha) +
  66. ", dhTheta=" + Arrays.toString(dhTheta) +
  67. ", masterboardVersion=" + masterboardVersion +
  68. ", controllerBoxType=" + controllerBoxType +
  69. ", robotType=" + robotType +
  70. ", robotSubType=" + robotSubType +
  71. '}';
  72. }
  73. }