Merge pull request #318 from dronekit/release-1.4.3.beta.3

Release 1.4.3 beta 3

Author: m4gr3d

ClientLib/build.gradle

@@ -5,7 +5,7 @@ ext {
     VERSION_MINOR = 6
     VERSION_PATCH = 8
     VERSION_BUILD = 0
-    VERSION_SUFFIX = "beta"
+    VERSION_SUFFIX = "release"
 
     PUBLISH_ARTIFACT_ID = 'dronekit-android'
     PUBLISH_VERSION = generateVersionName("", VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH, VERSION_SUFFIX)

ClientLib/src/main/java/com/o3dr/android/client/Drone.java

@@ -233,17 +233,23 @@ public void post(Runnable action) {
         handler.post(action);
     }
 
+    /**
+     * Reset the vehicle flight timer.
+     */
     public void resetFlightTimer() {
         elapsedFlightTime = 0;
         startTime = SystemClock.elapsedRealtime();
     }
 
-    public void stopTimer() {
+    private void stopTimer() {
         // lets calc the final elapsed timer
         elapsedFlightTime += SystemClock.elapsedRealtime() - startTime;
         startTime = SystemClock.elapsedRealtime();
     }
 
+    /**
+     * @return Vehicle flight time in seconds.
+     */
     public long getFlightTime() {
         State droneState = getAttribute(AttributeType.STATE);
         if (droneState != null && droneState.isFlying()) {

ClientLib/src/main/java/com/o3dr/android/client/apis/ControlApi.java

@@ -1,14 +1,19 @@
 package com.o3dr.android.client.apis;
 
 import android.os.Bundle;
+import android.support.annotation.IntDef;
 
 import com.o3dr.android.client.Drone;
 import com.o3dr.services.android.lib.coordinate.LatLong;
 import com.o3dr.services.android.lib.drone.attribute.AttributeType;
+import com.o3dr.services.android.lib.drone.attribute.error.CommandExecutionError;
+import com.o3dr.services.android.lib.drone.property.Attitude;
 import com.o3dr.services.android.lib.drone.property.Gps;
 import com.o3dr.services.android.lib.model.AbstractCommandListener;
 import com.o3dr.services.android.lib.model.action.Action;
 
+import java.lang.annotation.Retention;
+import java.lang.annotation.RetentionPolicy;
 import java.util.concurrent.ConcurrentHashMap;
 
 import static com.o3dr.services.android.lib.drone.action.ControlActions.ACTION_DO_GUIDED_TAKEOFF;
@@ -23,7 +28,6 @@
 import static com.o3dr.services.android.lib.drone.action.ControlActions.EXTRA_VELOCITY_Y;
 import static com.o3dr.services.android.lib.drone.action.ControlActions.EXTRA_VELOCITY_Z;
 import static com.o3dr.services.android.lib.drone.action.ControlActions.EXTRA_YAW_CHANGE_RATE;
-import static com.o3dr.services.android.lib.drone.action.ControlActions.EXTRA_YAW_IS_CLOCKWISE;
 import static com.o3dr.services.android.lib.drone.action.ControlActions.EXTRA_YAW_IS_RELATIVE;
 import static com.o3dr.services.android.lib.drone.action.ControlActions.EXTRA_YAW_TARGET_ANGLE;
 
@@ -36,6 +40,13 @@
  */
 public class ControlApi extends Api {
 
+    public static final int EARTH_NED_COORDINATE_FRAME = 0;
+    public static final int VEHICLE_COORDINATE_FRAME = 1;
+
+    @IntDef({EARTH_NED_COORDINATE_FRAME, VEHICLE_COORDINATE_FRAME})
+    @Retention(RetentionPolicy.SOURCE)
+    public @interface CoordinateFrame{}
+
     private static final ConcurrentHashMap<Drone, ControlApi> apiCache = new ConcurrentHashMap<>();
     private static final Builder<ControlApi> apiBuilder = new Builder<ControlApi>() {
         @Override
@@ -113,33 +124,67 @@ public void climbTo(double altitude) {
     /**
      * Instructs the vehicle to turn to the specified target angle
      * @param targetAngle Target angle in degrees [0-360], with 0 == north.
-     * @param turnSpeed Speed during turn in degrees per second
-     * @param isClockwise True for clockwise turn, false for counter clockwise turn
+     * @param turnRate Turning rate normalized to the range [-1.0f, 1.0f]. Positive values for clockwise turns, and negative values for counter-clockwise turns.
      * @param isRelative True is the target angle is relative to the current vehicle attitude, false otherwise if it's absolute.
      * @param listener Register a callback to receive update of the command execution state.
      */
-    public void turnTo(float targetAngle, float turnSpeed, boolean isClockwise, boolean isRelative, AbstractCommandListener listener){
+    public void turnTo(float targetAngle, float turnRate, boolean isRelative, AbstractCommandListener listener){
+        if(!isWithinBounds(targetAngle, 0, 360) || !isWithinBounds(turnRate, -1.0f, 1.0f)){
+            postErrorEvent(CommandExecutionError.COMMAND_FAILED, listener);
+            return;
+        }
+
         Bundle params = new Bundle();
         params.putFloat(EXTRA_YAW_TARGET_ANGLE, targetAngle);
-        params.putFloat(EXTRA_YAW_CHANGE_RATE, turnSpeed);
-        params.putBoolean(EXTRA_YAW_IS_CLOCKWISE, isClockwise);
+        params.putFloat(EXTRA_YAW_CHANGE_RATE, turnRate);
         params.putBoolean(EXTRA_YAW_IS_RELATIVE, isRelative);
         drone.performAsyncActionOnDroneThread(new Action(ACTION_SET_CONDITION_YAW, params), listener);
     }
 
-    /**
-     * Move the vehicle along the specified velocity vector.
-     *
-     * @param vx x velocity in meter / s
-     * @param vy y velocity in meter / s
-     * @param vz z velocity in meter / s
-     * @param listener Register a callback to receive update of the command execution state.
-     */
-    public void moveAtVelocity(float vx, float vy, float vz, AbstractCommandListener listener){
+    private void moveAtVelocity(float vx, float vy, float vz, AbstractCommandListener listener){
         Bundle params = new Bundle();
         params.putFloat(EXTRA_VELOCITY_X, vx);
         params.putFloat(EXTRA_VELOCITY_Y, vy);
         params.putFloat(EXTRA_VELOCITY_Z, vz);
         drone.performAsyncActionOnDroneThread(new Action(ACTION_SET_VELOCITY, params), listener);
     }
+
+    /**
+     * Move the vehicle along the specified velocity vector.
+     *
+     * @param referenceFrame Reference frame to use. Can be one of
+     *                       {@link #EARTH_NED_COORDINATE_FRAME},
+     *                       {@link #VEHICLE_COORDINATE_FRAME}
+     *
+     * @param vx             x velocity normalized to the range [-1.0f, 1.0f].
+     * @param vy             y velocity normalized to the range [-1.0f, 1.0f].
+     * @param vz             z velocity normalized to the range [-1.0f, 1.0f].
+     * @param listener       Register a callback to receive update of the command execution state.
+     */
+    public void moveAtVelocity(@CoordinateFrame int referenceFrame, float vx, float vy, float vz, AbstractCommandListener listener){
+        if(!isWithinBounds(vx, -1f, 1f) || !isWithinBounds(vy, -1f, 1f) || !isWithinBounds(vz, -1f, 1f)){
+            postErrorEvent(CommandExecutionError.COMMAND_FAILED, listener);
+            return;
+        }
+
+        float projectedX = vx;
+        float projectedY = vy;
+
+        if(referenceFrame == VEHICLE_COORDINATE_FRAME) {
+            Attitude attitude = drone.getAttribute(AttributeType.ATTITUDE);
+            double attitudeInRad = Math.toRadians(attitude.getYaw());
+
+            final double cosAttitude = Math.cos(attitudeInRad);
+            final double sinAttitude = Math.sin(attitudeInRad);
+
+            projectedX = (float) (vx * cosAttitude) - (float) (vy * sinAttitude);
+            projectedY = (float) (vx * sinAttitude) + (float) (vy * cosAttitude);
+        }
+
+        moveAtVelocity(projectedX, projectedY, vz, listener);
+    }
+
+    private static boolean isWithinBounds(float value, float lowerBound, float upperBound){
+        return value <= upperBound && value >= lowerBound;
+    }
 }

ClientLib/src/main/java/com/o3dr/services/android/lib/drone/action/ControlActions.java

@@ -21,7 +21,6 @@ public class ControlActions {
     public static final String ACTION_SET_CONDITION_YAW = PACKAGE_NAME + ".SET_CONDITION_YAW";
     public static final String EXTRA_YAW_TARGET_ANGLE = "extra_yaw_target_angle";
     public static final String EXTRA_YAW_CHANGE_RATE = "extra_yaw_change_rate";
-    public static final String EXTRA_YAW_IS_CLOCKWISE = "extra_yaw_is_clockwise";
     public static final String EXTRA_YAW_IS_RELATIVE = "extra_yaw_is_relative";
 
     public static final String ACTION_SET_VELOCITY = PACKAGE_NAME + ".SET_VELOCITY";

ClientLib/src/main/java/com/o3dr/services/android/lib/drone/mission/MissionItemType.java

@@ -9,6 +9,7 @@
 import com.o3dr.services.android.lib.drone.mission.item.command.ChangeSpeed;
 import com.o3dr.services.android.lib.drone.mission.item.command.DoJump;
 import com.o3dr.services.android.lib.drone.mission.item.command.EpmGripper;
+import com.o3dr.services.android.lib.drone.mission.item.command.ResetROI;
 import com.o3dr.services.android.lib.drone.mission.item.command.ReturnToLaunch;
 import com.o3dr.services.android.lib.drone.mission.item.command.SetRelay;
 import com.o3dr.services.android.lib.drone.mission.item.command.SetServo;
@@ -241,6 +242,7 @@ protected Creator<SplineSurvey> getMissionItemCreator() {
             return SplineSurvey.CREATOR;
         }
     },
+
     DO_JUMP("Do Jump") {
         @Override
         public MissionItem getNewItem() {
@@ -251,6 +253,18 @@ public MissionItem getNewItem() {
         protected Creator<DoJump> getMissionItemCreator() {
             return DoJump.CREATOR;
         }
+    },
+
+    RESET_ROI("Reset ROI") {
+        @Override
+        public MissionItem getNewItem() {
+            return new ResetROI();
+        }
+
+        @Override
+        protected Creator<ResetROI> getMissionItemCreator() {
+            return ResetROI.CREATOR;
+        }
     };
 
     private final static String EXTRA_MISSION_ITEM_TYPE = "extra_mission_item_type";

ClientLib/src/main/java/com/o3dr/services/android/lib/drone/mission/item/command/ResetROI.java

@@ -0,0 +1,51 @@
+package com.o3dr.services.android.lib.drone.mission.item.command;
+
+import android.os.Parcel;
+
+import com.o3dr.services.android.lib.drone.mission.MissionItemType;
+import com.o3dr.services.android.lib.drone.mission.item.MissionItem;
+
+/**
+ * Reset the current region of interest lock.
+ * Created by Fredia Huya-Kouadio on 10/20/15.
+ * @since 2.6.8
+ */
+public class ResetROI extends MissionItem implements MissionItem.Command {
+
+    public ResetROI(){
+        super(MissionItemType.RESET_ROI);
+    }
+
+    public ResetROI(ResetROI copy){
+        this();
+    }
+
+    @Override
+    public MissionItem clone() {
+        return new ResetROI(this);
+    }
+
+    @Override
+    public int describeContents() {
+        return 0;
+    }
+
+    @Override
+    public void writeToParcel(Parcel dest, int flags) {
+        super.writeToParcel(dest, flags);
+    }
+
+    protected ResetROI(Parcel in) {
+        super(in);
+    }
+
+    public static final Creator<ResetROI> CREATOR = new Creator<ResetROI>() {
+        public ResetROI createFromParcel(Parcel source) {
+            return new ResetROI(source);
+        }
+
+        public ResetROI[] newArray(int size) {
+            return new ResetROI[size];
+        }
+    };
+}

ClientLib/src/main/java/com/o3dr/services/android/lib/drone/mission/item/command/Takeoff.java

@@ -6,15 +6,15 @@
 import com.o3dr.services.android.lib.drone.mission.MissionItemType;
 
 /**
+ * The vehicle will climb straight up from it’s current location to the altitude specified (in meters).
+ * This should be the first command of nearly all missions.
+ * If the mission is begun while the copter is already flying, the vehicle will climb straight up to the specified altitude.
+ * If the vehicle is already above the specified altitude the takeoff command will be ignored and the mission will move onto the next command immediately.
+ *
  * Created by fhuya on 11/6/14.
  */
 public class Takeoff extends MissionItem implements MissionItem.Command, android.os.Parcelable {
 
-    /**
-     * Default takeoff altitude in meters.
-     */
-    public static final double DEFAULT_TAKEOFF_ALTITUDE = 10.0;
-
     private double takeoffAltitude;
     private double takeoffPitch;
 
@@ -28,10 +28,17 @@ public Takeoff(Takeoff copy){
         takeoffPitch = copy.takeoffPitch;
     }
 
+    /**
+     * @return take off altitude in meters
+     */
     public double getTakeoffAltitude() {
         return takeoffAltitude;
     }
 
+    /**
+     * Sets the take off altitude
+     * @param takeoffAltitude Altitude value in meters
+     */
     public void setTakeoffAltitude(double takeoffAltitude) {
         this.takeoffAltitude = takeoffAltitude;
     }

ClientLib/src/main/java/com/o3dr/services/android/lib/drone/mission/item/spatial/RegionOfInterest.java

@@ -7,6 +7,7 @@
 import com.o3dr.services.android.lib.drone.mission.item.MissionItem;
 
 /**
+ * Points the nose of the vehicle and camera gimbal at the “region of interest”.
  * Created by fhuya on 11/6/14.
  */
 public class RegionOfInterest extends BaseSpatialItem implements android.os.Parcelable {

ClientLib/src/main/java/com/o3dr/services/android/lib/drone/property/Gps.java

@@ -94,6 +94,14 @@ public void setPosition(LatLong mPosition) {
         this.mPosition = mPosition;
     }
 
+    /**
+     * @return True if there's a 3D GPS lock, false otherwise.
+     * @since 2.6.8
+     */
+    public boolean has3DLock(){
+        return (mFixType == LOCK_3D_TYPE) || (mFixType == LOCK_3D_DGPS_TYPE) || (mFixType == LOCK_3D_RTK_TYPE);
+    }
+
     @Override
     public boolean equals(Object o) {
         if (this == o) return true;

ServiceApp/build.gradle

@@ -42,7 +42,7 @@ dependencies {
 def versionMajor = 1
 def versionMinor = 4
 def versionPatch = 3
-def versionBuild = 2 //bump for dogfood builds, public betas, etc.
+def versionBuild = 3 //bump for dogfood builds, public betas, etc.
 def versionPrefix = "3DR Services v"
 
 //Log levels values

ServiceApp/src/org/droidplanner/services/android/api/DroneApi.java

@@ -458,18 +458,6 @@ public void onDroneEvent(DroneInterfaces.DroneEventsType event, MavLinkDrone dro
                 droneEvent = AttributeEvent.HOME_UPDATED;
                 break;
 
-            case GPS:
-                droneEvent = AttributeEvent.GPS_POSITION;
-                break;
-
-            case GPS_FIX:
-                droneEvent = AttributeEvent.GPS_FIX;
-                break;
-
-            case GPS_COUNT:
-                droneEvent = AttributeEvent.GPS_COUNT;
-                break;
-
             case CALIBRATION_IMU:
                 final String calIMUMessage = drone.getCalibrationSetup().getMessage();
                 extrasBundle = new Bundle(1);

ServiceApp/src/org/droidplanner/services/android/core/MAVLink/MavLinkModes.java renamed to ServiceApp/src/org/droidplanner/services/android/core/MAVLink/MavLinkCommands.java

@@ -3,6 +3,7 @@
 import org.droidplanner.services.android.core.drone.variables.ApmModes;
 
 import com.MAVLink.common.msg_command_long;
+import com.MAVLink.common.msg_manual_control;
 import com.MAVLink.common.msg_mission_item;
 import com.MAVLink.common.msg_set_position_target_global_int;
 import com.MAVLink.common.msg_set_mode;
@@ -13,7 +14,7 @@
 
 import org.droidplanner.services.android.core.drone.autopilot.MavLinkDrone;
 
-public class MavLinkModes {
+public class MavLinkCommands {
 
     private static final int MAVLINK_SET_POS_TYPE_MASK_POS_IGNORE = ((1 << 0) | (1 << 1) | (1 << 2));
     private static final int MAVLINK_SET_POS_TYPE_MASK_VEL_IGNORE = ((1 << 3) | (1 << 4) | (1 << 5));
@@ -111,4 +112,28 @@ public static void setConditionYaw(MavLinkDrone drone, float targetAngle, float
 
         drone.getMavClient().sendMavMessage(msg, listener);
     }
+
+    /**
+     * API for sending manually control to the vehicle using standard joystick axes nomenclature, along with a joystick-like input device.
+     * Unused axes can be disabled and buttons are also transmit as boolean values.
+     * @see <a href="MANUAL_CONTROL">https://pixhawk.ethz.ch/mavlink/#MANUAL_CONTROL</a>
+     *
+     * @param drone
+     * @param x X-axis, normalized to the range [-1000,1000]. A value of INT16_MAX indicates that this axis is invalid. Generally corresponds to forward(1000)-backward(-1000) movement on a joystick and the pitch of a vehicle.
+     * @param y Y-axis, normalized to the range [-1000,1000]. A value of INT16_MAX indicates that this axis is invalid. Generally corresponds to left(-1000)-right(1000) movement on a joystick and the roll of a vehicle.
+     * @param z Z-axis, normalized to the range [-1000,1000]. A value of INT16_MAX indicates that this axis is invalid. Generally corresponds to a separate slider movement with maximum being 1000 and minimum being -1000 on a joystick and the thrust of a vehicle.
+     * @param r R-axis, normalized to the range [-1000,1000]. A value of INT16_MAX indicates that this axis is invalid. Generally corresponds to a twisting of the joystick, with counter-clockwise being 1000 and clockwise being -1000, and the yaw of a vehicle.
+     * @param buttons A bitfield corresponding to the joystick buttons' current state, 1 for pressed, 0 for released. The lowest bit corresponds to Button 1.
+     * @param listener
+     */
+    public static void sendManualControl(MavLinkDrone drone, short x, short y, short z, short r, int buttons, ICommandListener listener){
+        msg_manual_control msg = new msg_manual_control();
+        msg.target = drone.getSysid();
+        msg.x = x;
+        msg.y = y;
+        msg.z = z;
+        msg.r = r;
+        msg.buttons = buttons;
+        drone.getMavClient().sendMavMessage(msg, listener);
+    }
 }