|
@@ -28,12 +28,6 @@ public class SecondaryClient {
|
|
|
this.rt = new Socket(ip, port);
|
|
|
this.os = rt.getOutputStream();
|
|
|
this.in = new CountDataInputStream(rt.getInputStream());
|
|
|
-// byte[] data=new byte[4096];
|
|
|
-// this.in.readFully(data);
|
|
|
-// FileOutputStream fos = new FileOutputStream("data2.txt");
|
|
|
-// fos.write(data);
|
|
|
-// fos.close();
|
|
|
-
|
|
|
VersionMessage vm = new VersionMessage();
|
|
|
vm.read(in, -1);
|
|
|
return vm;
|
|
@@ -70,38 +64,47 @@ public class SecondaryClient {
|
|
|
switch (pType) {
|
|
|
case PackageType.ROBOT_MODE_DATA:
|
|
|
var md=readRobotModeData(di, size);
|
|
|
+ Log.add(md);
|
|
|
log.info(md.toString());
|
|
|
break;
|
|
|
case PackageType.JOINT_DATA:
|
|
|
var jd=readJointData(di, size);
|
|
|
+ Log.add(jd);
|
|
|
log.info(jd.toString());
|
|
|
break;
|
|
|
case PackageType.TOOL_DATA:
|
|
|
var td=readToolData(di, size);
|
|
|
+ Log.add(td);
|
|
|
log.info(td.toString());
|
|
|
break;
|
|
|
case PackageType.MASTERBOARD_DATA:
|
|
|
var mb=readMasterBoardData(di, size);
|
|
|
+ Log.add(mb);
|
|
|
log.info(mb.toString());
|
|
|
break;
|
|
|
case PackageType.CARTESIAN_INFO:
|
|
|
var c=readCartesianInfo(di, size);
|
|
|
+ Log.add(c);
|
|
|
log.info(c.toString());
|
|
|
break;
|
|
|
case PackageType.KINEMATICS_INFO:
|
|
|
var ki=readKinemsticsInfo(di, size);
|
|
|
+ Log.add(ki);
|
|
|
log.info(ki.toString());
|
|
|
break;
|
|
|
case PackageType.CONFIGURATION_DATA:
|
|
|
var cd=readConfigurationData(di, size);
|
|
|
+ Log.add(cd);
|
|
|
log.info(cd.toString());
|
|
|
break;
|
|
|
case PackageType.FORCE_MODE_DATA:
|
|
|
var fmd=readForceModeData(di, size);
|
|
|
+ Log.add(fmd);
|
|
|
log.info(fmd.toString());
|
|
|
break;
|
|
|
case PackageType.ADDITIONAL_INFO:
|
|
|
var ai=readAdditionalInfo(di, size);
|
|
|
+ Log.add(ai);
|
|
|
log.info(ai.toString());
|
|
|
break;
|
|
|
case PackageType.NEEDED_FOR_CALIB_DATA:
|
|
@@ -112,6 +115,7 @@ public class SecondaryClient {
|
|
|
break;
|
|
|
case PackageType.TOOL_COMM_INFO:
|
|
|
var tci=readToolCommInfo(di, size);
|
|
|
+ Log.add(tci);
|
|
|
log.info(tci.toString());
|
|
|
break;
|
|
|
default:
|
|
@@ -139,6 +143,12 @@ public class SecondaryClient {
|
|
|
return td;
|
|
|
}
|
|
|
|
|
|
+ private JointDataList readJointData(CountDataInputStream di, int size) throws IOException {
|
|
|
+ JointDataList td=new JointDataList();
|
|
|
+ td.read(di, size);
|
|
|
+ return td;
|
|
|
+ }
|
|
|
+
|
|
|
private ToolCommInfo readToolCommInfo(CountDataInputStream di, int size) throws IOException {
|
|
|
ToolCommInfo tci=new ToolCommInfo();
|
|
|
tci.read(di, size);
|
|
@@ -220,17 +230,6 @@ public class SecondaryClient {
|
|
|
return md;
|
|
|
}
|
|
|
|
|
|
- JointData[] readJointData(CountDataInputStream di, int size) throws IOException {
|
|
|
- int joints = size / 41;
|
|
|
- JointData[] jds = new JointData[size];
|
|
|
- for (int i = 0; i < joints; i++) {
|
|
|
- JointData jd = new JointData();
|
|
|
- jd.read(di, size);
|
|
|
- jds[i] = jd;
|
|
|
- }
|
|
|
- return jds;
|
|
|
- }
|
|
|
-
|
|
|
|
|
|
public void writeCmd(String cmd) {
|
|
|
try {
|