ConfigurationData.java 3.0 KB

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