Subversion Repositories Projects

Rev

Rev 1540 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1540 Rev 1695
Line 1... Line 1...
1
package dongfang.mkt.frames;
1
package dongfang.mkt.frames;
2
 
2
 
3
public class AttitudeDataResponseFrame extends ResponseFrame {
3
public class AttitudeDataResponseFrame extends ResponseFrame {
4
        // signed int  Winkel[3]; // nick, roll, compass in 0,1�
-
 
5
        // signed char reserve[8];
-
 
6
        private int pitch;
4
        private float[] attitude;
7
        private int roll;
5
        private float[] rates;
8
        private int heading;
6
        private float[] acc;
9
        private int[] expansion;
-
 
10
       
7
       
11
        public AttitudeDataResponseFrame(int address) {
8
        public AttitudeDataResponseFrame(int address) {
12
                super(address);
9
                super(address);
13
        }
10
        }
14
 
11
 
15
        @Override
12
        @Override
16
        public boolean isResponseTo(RequestFrame r) {
13
        public boolean isResponseTo(RequestFrame r) {
17
                return r instanceof AttitudeDataRequestFrame;
14
                return r instanceof AttitudeDataRequestFrame;
18
        }
15
        }
19
 
16
 
20
        public int getPitch() {
17
        public float[] getAttitude() {
21
                return pitch;
18
                return attitude;
22
        }
19
        }
23
 
20
 
24
        public void setPitch(int pitch) {
21
        public void setAttitude(float[] attitude) {
25
                this.pitch = pitch;
22
                this.attitude = attitude;
26
        }
23
        }
27
 
24
 
28
        public int getRoll() {
25
        public float[] getRates() {
29
                return roll;
26
                return rates;
30
        }
27
        }
31
 
28
 
32
        public void setRoll(int roll) {
29
        public void setRates(float[] rates) {
33
                this.roll = roll;
30
                this.rates = rates;
34
        }
31
        }
35
 
32
 
36
        public int getHeading() {
33
        public float[] getAcc() {
37
                return heading;
34
                return acc;
38
        }
35
        }
39
 
36
 
40
        public void setHeading(int heading) {
37
        public void setAcc(float[] acc) {
41
                this.heading = heading;
38
                this.acc = acc;
42
        }
39
        }
43
 
40
       
44
        public int[] getExpansion() {
41
        public String toString() {
45
                return expansion;
42
                String result =  "pitch: " + attitude[0] + ", roll: " + attitude[1] + ", yaw: " + attitude[2];
46
        }
-
 
47
 
-
 
-
 
43
                result += ", pitchRate: " + rates[0] + ", rollRate: " + rates[1] + ", yawRate: " + rates[2];
48
        public void setExpansion(int[] expansion) {
44
                result += ", X: " + acc[0] + ", Y: " + acc[1] + ", Z: " + acc[2];
49
                this.expansion = expansion;
45
                return result;
50
        }
46
        }
51
}
47
}