Subversion Repositories Projects

package dongfang.mkt.frames;

public class OSDDataResponseFrame extends ResponseFrame {

        public static class GPSPosition {
                int longitude; // in 1E-7 degrees. 32 bit signed.
                int latitude;  // in 1E-7 degrees. 32 bit signed.
                long altitude;  // in mm. 32 bit signed.
                int status;
                public int getLongitude() {
                        return longitude;
                }
                public int getLatitude() {
                        return latitude;
                }
                public long getAltitude() {
                        return altitude;
                }
                public int getStatus() {
                        return status;
                }
                public void setLongitude(int longitude) {
                        this.longitude = longitude;
                }
                public void setLatitude(int latitude) {
                        this.latitude = latitude;
                }
                public void setAltitude(long altitude) {
                        this.altitude = altitude;
                }
                public void setStatus(int status) {
                        this.status = status;
                }
               
                public String toXML() {
                        double latitude = Math.abs(this.latitude);
                        String result = "latitude=\"" + latitude/1E7;
                        if (this.latitude < 0) result+= "S"; else result+="N";
                        result += "\"";
                        double longitude= Math.abs(this.longitude);
                        result += " longitude=\"" + longitude/1E7;
                        if (this.longitude < 0) result+= "W"; else result+="E";
                        result += "\"";
                        return result;
                }

                public String toString() {
                        double latitude = Math.abs(this.latitude);
                        String result = "" + latitude/1E7;
                        if (this.latitude < 0) result+= "S"; else result+="N";
                        result += " ";
                        double longitude= Math.abs(this.longitude);
                        result += "" + longitude/1E7;
                        if (this.longitude < 0) result+= "W"; else result+="E";
                        return result;
                }
        }
       
        public static class GPSDistanceAndBearing {
                int distance;   // in m/10. 16 bit unsigned.
                int bearing;    // in degrees. 16 bit signed.
                public int getDistance() {
                        return distance;
                }
                public int getBearing() {
                        return bearing;
                }
                public void setDistance(int distance) {
                        this.distance = distance;
                }
                public void setBearing(int bearing) {
                        this.bearing = bearing;
                }
                public String toXML() {
                        String result = "distance=\"" + ((double)this.distance)/10;
                        result += "\" bearing=\"";
                        result += this.bearing;
                        result += "\"";
                        return result; 
                }
                public String toString() {
                        String result = "" + ((double)this.distance)/10;
                        result += "m @";
                        result += this.bearing;
                        result += "deg";
                        return result; 
                }
        }

        private int version;
        private GPSPosition currentPosition;
        private GPSPosition targetPosition;
        private GPSDistanceAndBearing currentToTarget;
        private GPSPosition homePosition;
        private GPSDistanceAndBearing currentToHome;
       
        private int waypointIndex;
        private int waypointCount;
       
        private int numberOfSatellites;
        private int heightByPressure;           // 16 bit signed.
        private int verticalVelocityByPressure; // 16 bit signed.
       
        private int flightTime; // in secs. 16 bit unsigned.
        private int batteryVoltage; // in 0.1 volts.

        private int groundSpeed; // in cm/s. 16 bit unsigned.
        private int directionOfFlight;     // of movement. 16 bit signed.
        private int compassHeading;// 16 bit signed.
       
        private int pitchAngle;
        private int rollAngle;
       
        private int rcQuality;
        private int fcFlags;
        private int ncFlags;
        private int errorCode;
       
        private int operatingRadius;
        private int verticalVelocityByGPS;      // 16 bit signed.
       
        private int targetLoiterTime;
        private int fcFlags2;
        private int setpointForAltitude;        // 16 bit signed.
       
        private int throttle;    
        private int current;      // 16 bit unsigned.
        private int capacityUsed; // 16 bit unsigned.
       
        public OSDDataResponseFrame(int address) {
                super(address);
        }
       
        public int getVersion() {
                return version;
        }
        public GPSPosition getCurrentPosition() {
                return currentPosition;
        }
        public GPSPosition getTargetPosition() {
                return targetPosition;
        }
        public GPSDistanceAndBearing getCurrentToTarget() {
                return currentToTarget;
        }
        public GPSPosition getHomePosition() {
                return homePosition;
        }
        public GPSDistanceAndBearing getCurrentToHome() {
                return currentToHome;
        }
        public int getWaypointIndex() {
                return waypointIndex;
        }
        public int getWaypointCount() {
                return waypointCount;
        }
        public int getNumberOfSatellites() {
                return numberOfSatellites;
        }
        public int getHeightByPressure() {
                return heightByPressure;
        }
        public int getVerticalVelocityByPressure() {
                return verticalVelocityByPressure;
        }
        public int getFlightTime() {
                return flightTime;
        }
        public int getBatteryVoltage() {
                return batteryVoltage;
        }
        public int getGroundSpeed() {
                return groundSpeed;
        }
        public int getDirectionOfFlight() {
                return directionOfFlight;
        }
        public int getCompassHeading() {
                return compassHeading;
        }
        public int getPitchAngle() {
                return pitchAngle;
        }
        public int getRollAngle() {
                return rollAngle;
        }
        public int getRcQuality() {
                return rcQuality;
        }
        public int getFcFlags() {
                return fcFlags;
        }
        public int getNcFlags() {
                return ncFlags;
        }
        public int getErrorCode() {
                return errorCode;
        }
        public int getOperatingRadius() {
                return operatingRadius;
        }
        public int getVerticalVelocityByGPS() {
                return verticalVelocityByGPS;
        }
        public int getTargetLoiterTime() {
                return targetLoiterTime;
        }
        public int getFcFlags2() {
                return fcFlags2;
        }
        public int getSetpointForAltitude() {
                return setpointForAltitude;
        }
        public int getThrottle() {
                return throttle;
        }
        public int getCurrent() {
                return current;
        }
        public int getCapacityUsed() {
                return capacityUsed;
        }
        public void setVersion(int version) {
                this.version = version;
        }
        public void setCurrentPosition(GPSPosition currentPosition) {
                this.currentPosition = currentPosition;
        }
        public void setTargetPosition(GPSPosition targetPosition) {
                this.targetPosition = targetPosition;
        }
        public void setCurrentToTarget(GPSDistanceAndBearing currentToTarget) {
                this.currentToTarget = currentToTarget;
        }
        public void setHomePosition(GPSPosition homePosition) {
                this.homePosition = homePosition;
        }
        public void setCurrentToHome(GPSDistanceAndBearing currentToHome) {
                this.currentToHome = currentToHome;
        }
        public void setWaypointIndex(int waypointIndex) {
                this.waypointIndex = waypointIndex;
        }
        public void setWaypointCount(int waypointCount) {
                this.waypointCount = waypointCount;
        }
        public void setNumberOfSatellites(int numberOfSatellites) {
                this.numberOfSatellites = numberOfSatellites;
        }
        public void setHeightByPressure(int heightByPressure) {
                this.heightByPressure = heightByPressure;
        }
        public void setVerticalVelocityByPressure(int verticalVelocityByPressure) {
                this.verticalVelocityByPressure = verticalVelocityByPressure;
        }
        public void setFlightTime(int flightTime) {
                this.flightTime = flightTime;
        }
        public void setBatteryVoltage(int batteryVoltage) {
                this.batteryVoltage = batteryVoltage;
        }
        public void setGroundSpeed(int groundSpeed) {
                this.groundSpeed = groundSpeed;
        }
        public void setDirectionOfFlight(int heading) {
                this.directionOfFlight = heading;
        }
        public void setCompassHeading(int compassHeading) {
                this.compassHeading = compassHeading;
        }
        public void setPitchAngle(int pitchAngle) {
                this.pitchAngle = pitchAngle;
        }
        public void setRollAngle(int rollAngle) {
                this.rollAngle = rollAngle;
        }
        public void setRcQuality(int rcQuality) {
                this.rcQuality = rcQuality;
        }
        public void setFcFlags(int fcFlags) {
                this.fcFlags = fcFlags;
        }
        public void setNcFlags(int ncFlags) {
                this.ncFlags = ncFlags;
        }
        public void setErrorCode(int errorCode) {
                this.errorCode = errorCode;
        }
        public void setOperatingRadius(int operatingRadius) {
                this.operatingRadius = operatingRadius;
        }
        public void setVerticalVelocityByGPS(int verticalVelocityByGPS) {
                this.verticalVelocityByGPS = verticalVelocityByGPS;
        }
        public void setTargetLoiterTime(int targetLoiterTime) {
                this.targetLoiterTime = targetLoiterTime;
        }
        public void setFcFlags2(int fcFlags2) {
                this.fcFlags2 = fcFlags2;
        }
        public void setSetpointForAltitude(int setpointForAltitude) {
                this.setpointForAltitude = setpointForAltitude;
        }
        public void setThrottle(int throttle) {
                this.throttle = throttle;
        }
        public void setCurrent(int current) {
                this.current = current;
        }
        public void setCapacityUsed(int capacityUsed) {
                this.capacityUsed = capacityUsed;
        }

        @Override
        public boolean isResponseTo(RequestFrame r) {
                return r instanceof OSDDataRequestFrame;
        }
       
        public String toString() {
                StringBuilder result = new StringBuilder();
                result.append("OSDData version=" + this.version + "\n");
                result.append("currentPosition: " + this.currentPosition + "\n");
                result.append("targetPosition: " + this.targetPosition + " (" + this.currentToTarget + ")" + "\n");
                result.append("homePosition: " + this.homePosition + " (" + this.currentToHome + ")" + "\n");
                result.append("heightByPressure: " + this.heightByPressure + "\n");
                result.append("verticalVelocityByPressure: " + this.verticalVelocityByPressure + "\n");
                result.append("verticalVelocityByGPS: " + this.verticalVelocityByGPS + "\n");
                result.append("direction of flight: " + this.directionOfFlight + "\n");
                result.append("compassHeading: " + this.compassHeading + "\n");
                result.append("pitchAngle: " + this.pitchAngle + "\n");
                result.append("rollAngle: " + this.rollAngle + "\n");
                result.append("battery voltage: " + ((double)this.batteryVoltage)/10 + "\n");
                result.append("throttle: " + this.throttle + "\n");
                return result.toString();
        }
}