Added cancel event to the state machine.

src/rosjava_actionlib/rosjava_actionlib/src/main/java/com/github/ekumen/rosjava_actionlib/ClientStateMachine.java

@@ -25,9 +25,6 @@ import java.util.Iterator;
 /**
  * State machine for the action client.
  * @author Ernesto Corbellini ecorbellini@ekumenlabs.com
- * Comments:
- *   - The state returned on a transition is actually a vector of states that should be transitioned in sequence.
- *  TODO: change class name to ClientStateMachine
   */
 public class ClientStateMachine {
   // Local class to hold the states
@@ -45,7 +42,6 @@ public class ClientStateMachine {
     public final static int LOST = 8;
   }
 
-  ActionGoal goal;
   int latestGoalStatus;
   int state;
   int nextState;
@@ -61,14 +57,6 @@ public class ClientStateMachine {
     //this.goal = actionGoal;
   }
 
-  /*
-   * Compare two objects.
-   */
-  public boolean equals(ClientStateMachine obj) {
-    //return actionGoal.goalId.id == obj.actionGoal.goalId.id;
-    return true;
-  }
-
   public synchronized void setState(int state) {
     this.state = state;
   }
@@ -422,6 +410,25 @@ public class ClientStateMachine {
     return stateList;
   }
 
+  /**
+   * Cancel action goal. The goal can only be cancelled if its in certain
+   * states. If it can be cancelled the state will be changed to
+   * WAITING_FOR_CANCEL_ACK.
+   * @return True if the goal can be cancelled, false otherwise.
+   */
+  public boolean cancel() {
+    bolean ret = false;
+    switch (stateMachine.getState()) {
+      case ClientStates.WAITING_FOR_GOAL_ACK:
+      case ClientStates.PENDING:
+      case ClientStates.ACTIVE:
+        this.state = ClientStates.WAITING_FOR_CANCEL_ACK;
+        ret = true;
+        break;
+    }
+    return ret;
+  }
+
   public void markAsLost()
   {
   }