Advertisement
Guest User

MeldingsProtokoll

a guest
Feb 8th, 2016
52
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Java 2.34 KB | None | 0 0
  1. //Handshake
  2. JSONObject handshake = new JSONObject();                //HandshakeMessage
  3. handshake.put("r", "Arduino");                          //RobotName
  4. handshake.put("m", 2);                                  //MessageType
  5. handshake.put("w", 10.0);                               //RobotWidth
  6. handshake.put("l", 20.0);                               //RobotLength
  7. handshake.put("to", new double[]{0.0, 0.0});            //TowerOffset
  8. handshake.put("ao", 0.0);                               //AxleOffset
  9. handshake.put("so", new double[]{0.0, 0.0, 0.0, 0.0});  //SensorOffset
  10. handshake.put("dl", 200);                               //MessageDeadline
  11. JSONObject irsensorheading = new JSONObject();
  12. irsensorheading.put("s1", 0);                           //IRsensorHeading
  13. irsensorheading.put("s2", 90);                          //IRsensorHeading
  14. irsensorheading.put("s3", 180);                         //IRsensorHeading
  15. irsensorheading.put("s4", 270);                         //IRsensorHeading
  16. handshake.put("irh", irsensorheading);
  17. inbox.putMessage(handshake);
  18.  
  19. //Update
  20. JSONObject update = new JSONObject();               //UpdateMessage
  21. JSONObject position = new JSONObject();
  22. position.put("p1", 0);                              //RobotXpos
  23. position.put("p2", 0);                              //RobotYpos
  24. JSONObject irsensordata = new JSONObject();
  25. irsensordata.put("s1", 10);                         //IRsensorData
  26. irsensordata.put("s2", 15);                         //IRsensorData
  27. irsensordata.put("s3", 10);                         //IRsensorData
  28. irsensordata.put("s4", 15);                         //IRsensorData
  29. irsensorheading = new JSONObject();
  30. irsensorheading.put("s1", 0);                       //IRsensorHeading
  31. irsensorheading.put("s2", 90);                      //IRsensorHeading
  32. irsensorheading.put("s3", 180);                     //IRsensorHeading
  33. irsensorheading.put("s4", 270);                     //IRsensorHeading
  34. update.put("r", "1");                               //RobotID
  35. update.put("m", 1);                                 //MessageType
  36. update.put("pd", position);                         //PositionData
  37. update.put("o", 0.0);                               //Orientation
  38. update.put("irh", irsensorheading);                 //IRHeading
  39. update.put("ird", irsensordata);                    //IRData
  40. inbox.putMessage(update);
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement