|
| 1 | +import java.awt.*; |
| 2 | +import java.awt.event.*; |
| 3 | +import java.io.*; |
| 4 | +import java.util.*; |
| 5 | +import rcx.RCXPort; |
| 6 | +import rcx.RCXErrorListener; |
| 7 | +import rcx.Motor; |
| 8 | +import rcx.Sensor; |
| 9 | +import rcx.SensorConstants; |
| 10 | + |
| 11 | +public class RCXControl extends Panel implements ActionListener, |
| 12 | + RCXErrorListener, Runnable |
| 13 | +{ |
| 14 | + private String portName; |
| 15 | + private RCXPort rcxPort; |
| 16 | + private Thread thisThread; |
| 17 | + private boolean isRunning; |
| 18 | + private Panel topPanel,bottomPanel; |
| 19 | + private TextField sensorField1,sensorField2,sensorField3; |
| 20 | + private Panel motorPanel1,motorPanel2,motorPanel3; |
| 21 | + private Button motor1fwd,motor1bwd,motor1stop,motor1float; |
| 22 | + private Button motor2fwd,motor2bwd,motor2stop,motor2float; |
| 23 | + private Button motor3fwd,motor3bwd,motor3stop,motor3float; |
| 24 | + private int s1value,s1prevalue,s2value,s2prevalue,s3value,s3prevalue; |
| 25 | + |
| 26 | + public RCXControl(String portname) { |
| 27 | + |
| 28 | + portName = portname; |
| 29 | + |
| 30 | + topPanel = new Panel(); |
| 31 | + topPanel.setLayout(new FlowLayout(FlowLayout.CENTER,4,4)); |
| 32 | + bottomPanel = new Panel(); |
| 33 | + bottomPanel.setLayout(new FlowLayout(FlowLayout.CENTER,5,5)); |
| 34 | + motorPanel1 = new Panel(); |
| 35 | + motorPanel1.setLayout(new BorderLayout(5,5)); |
| 36 | + motorPanel2 = new Panel(); |
| 37 | + motorPanel2.setLayout(new BorderLayout(5,5)); |
| 38 | + motorPanel3 = new Panel(); |
| 39 | + motorPanel3.setLayout(new BorderLayout(5,5)); |
| 40 | + |
| 41 | + sensorField1 = new TextField(9); |
| 42 | + sensorField1.setEditable(false); |
| 43 | + sensorField1.setEnabled(false); |
| 44 | + sensorField2 = new TextField(9); |
| 45 | + sensorField2.setEditable(false); |
| 46 | + sensorField2.setEnabled(false); |
| 47 | + sensorField3 = new TextField(9); |
| 48 | + sensorField3.setEditable(false); |
| 49 | + sensorField3.setEnabled(false); |
| 50 | + |
| 51 | + motor1fwd = new Button("forward"); |
| 52 | + motor1fwd.addActionListener(this); |
| 53 | + motor2fwd = new Button("forward"); |
| 54 | + motor2fwd.addActionListener(this); |
| 55 | + motor3fwd = new Button("forward"); |
| 56 | + motor3fwd.addActionListener(this); |
| 57 | + motor1bwd = new Button("backward"); |
| 58 | + motor1bwd.addActionListener(this); |
| 59 | + motor2bwd = new Button("backward"); |
| 60 | + motor2bwd.addActionListener(this); |
| 61 | + motor3bwd = new Button("backward"); |
| 62 | + motor3bwd.addActionListener(this); |
| 63 | + motor1stop = new Button("stop"); |
| 64 | + motor1stop.addActionListener(this); |
| 65 | + motor2stop = new Button("stop"); |
| 66 | + motor2stop.addActionListener(this); |
| 67 | + motor3stop = new Button("stop"); |
| 68 | + motor3stop.addActionListener(this); |
| 69 | + motor1float = new Button("float"); |
| 70 | + motor1float.addActionListener(this); |
| 71 | + motor2float = new Button("float"); |
| 72 | + motor2float.addActionListener(this); |
| 73 | + motor3float = new Button("float"); |
| 74 | + motor3float.addActionListener(this); |
| 75 | + |
| 76 | + topPanel.add(sensorField1); |
| 77 | + topPanel.add(sensorField2); |
| 78 | + topPanel.add(sensorField3); |
| 79 | + |
| 80 | + motorPanel1.add(motor1fwd,"North"); |
| 81 | + motorPanel1.add(motor1bwd,"South"); |
| 82 | + motorPanel1.add(motor1float,"East"); |
| 83 | + motorPanel1.add(motor1stop,"West"); |
| 84 | + motorPanel2.add(motor2fwd,"North"); |
| 85 | + motorPanel2.add(motor2bwd,"South"); |
| 86 | + motorPanel2.add(motor2float,"East"); |
| 87 | + motorPanel2.add(motor2stop,"West"); |
| 88 | + motorPanel3.add(motor3fwd,"North"); |
| 89 | + motorPanel3.add(motor3bwd,"South"); |
| 90 | + motorPanel3.add(motor3float,"East"); |
| 91 | + motorPanel3.add(motor3stop,"West"); |
| 92 | + |
| 93 | + bottomPanel.add(motorPanel1); |
| 94 | + bottomPanel.add(motorPanel2); |
| 95 | + bottomPanel.add(motorPanel3); |
| 96 | + |
| 97 | + setLayout(new BorderLayout()); |
| 98 | + add(topPanel,"North"); |
| 99 | + add(bottomPanel,"South"); |
| 100 | + setBackground(Color.yellow); |
| 101 | + |
| 102 | + thisThread = new Thread(this); |
| 103 | + thisThread.start(); |
| 104 | + } |
| 105 | + |
| 106 | + public void run() { |
| 107 | + rcxPort = new RCXPort(portName); |
| 108 | + rcxPort.addRCXErrorListener(this); |
| 109 | + |
| 110 | + Sensor.S1.setTypeAndMode(SensorConstants.SENSOR_TYPE_LIGHT, |
| 111 | + SensorConstants.SENSOR_MODE_PCT); |
| 112 | + Sensor.S2.setTypeAndMode(SensorConstants.SENSOR_TYPE_LIGHT, |
| 113 | + SensorConstants.SENSOR_MODE_PCT); |
| 114 | + Sensor.S3.setTypeAndMode(SensorConstants.SENSOR_TYPE_LIGHT, |
| 115 | + SensorConstants.SENSOR_MODE_PCT); |
| 116 | + isRunning=true; |
| 117 | + |
| 118 | + sensorField1.setText("0"); |
| 119 | + sensorField2.setText("0"); |
| 120 | + sensorField3.setText("0"); |
| 121 | + |
| 122 | + while(isRunning) { |
| 123 | + // this delay can be adjusted or eliminated |
| 124 | + try{Thread.sleep(1000);}catch(Exception e) { } |
| 125 | + |
| 126 | + s1value=Sensor.S1.readValue(); |
| 127 | + if(s1value!=s1prevalue) { |
| 128 | + s1prevalue=s1value; |
| 129 | + sensorField1.setText(Integer.toString(s1value)); |
| 130 | + } |
| 131 | + s2value=Sensor.S2.readValue(); |
| 132 | + if(s2value!=s2prevalue) { |
| 133 | + s2prevalue=s2value; |
| 134 | + sensorField2.setText(Integer.toString(s2value)); |
| 135 | + } |
| 136 | + s3value=Sensor.S3.readValue(); |
| 137 | + if(s3value!=s3prevalue) { |
| 138 | + s3prevalue=s3value; |
| 139 | + sensorField3.setText(Integer.toString(s3value)); |
| 140 | + } |
| 141 | + } |
| 142 | + } |
| 143 | + |
| 144 | + public void actionPerformed(ActionEvent e) { |
| 145 | + Object obj = e.getSource(); |
| 146 | + if(obj==motor1fwd) { |
| 147 | + Motor.A.forward(); |
| 148 | + } |
| 149 | + else if(obj==motor1bwd) { |
| 150 | + Motor.A.backward(); |
| 151 | + } |
| 152 | + else if(obj==motor1stop) { |
| 153 | + Motor.A.stop(); |
| 154 | + } |
| 155 | + else if(obj==motor1float) { |
| 156 | + Motor.A.flt(); |
| 157 | + } |
| 158 | + else if(obj==motor2fwd) { |
| 159 | + Motor.B.forward(); |
| 160 | + } |
| 161 | + else if(obj==motor2bwd) { |
| 162 | + Motor.B.backward(); |
| 163 | + } |
| 164 | + else if(obj==motor2stop) { |
| 165 | + Motor.B.stop(); |
| 166 | + } |
| 167 | + else if(obj==motor2float) { |
| 168 | + Motor.B.flt(); |
| 169 | + } |
| 170 | + else if(obj==motor3fwd) { |
| 171 | + Motor.C.forward(); |
| 172 | + } |
| 173 | + else if(obj==motor3bwd) { |
| 174 | + Motor.C.backward(); |
| 175 | + } |
| 176 | + else if(obj==motor3stop) { |
| 177 | + Motor.C.stop(); |
| 178 | + } |
| 179 | + else if(obj==motor3float) { |
| 180 | + Motor.C.flt(); |
| 181 | + } |
| 182 | + } |
| 183 | + |
| 184 | + public void receivedError(String error) { |
| 185 | + System.err.println("Error: "+error); |
| 186 | + close(); |
| 187 | + } |
| 188 | + |
| 189 | + public void close() { |
| 190 | + isRunning=false; |
| 191 | + if(rcxPort!=null) |
| 192 | + rcxPort.close(); |
| 193 | + } |
| 194 | +} |
0 commit comments