Changeset 99 in pacpussensors for trunk/NMEA0183/src
- Timestamp:
- Oct 15, 2015, 2:47:01 PM (9 years ago)
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/NMEA0183/src/HSATIT.cpp
r59 r99 1 1 #include "HSATIT.hpp" 2 2 #include "nmea0183.h" 3 3 4 4 … … 19 19 { 20 20 21 22 heading = 0.0; 23 roll = 0.0; 24 pitch = 0.0; 25 heave = 0.0; 26 yawRotationRate = 0.0; 27 rollRotationRate = 0.0; 21 22 heading = 0.0; 23 roll = 0.0; 24 pitch = 0.0; 25 heave = 0.0; 26 yawRotationRate = 0.0; 27 rollRotationRate = 0.0; 28 28 pitchRotationRate = 0.0; 29 courseMadeGood = 0.0; 29 courseMadeGood = 0.0; 30 30 speedOverGround = 0.0; 31 longitudinalVel = 0.0; 31 longitudinalVel = 0.0; 32 32 transveralVel = 0.0; 33 33 verticalVel = 0.0; … … 43 43 { 44 44 /* 45 ** HSATIT 45 ** HSATIT 46 46 ** 47 47 ** 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 … … 49 49 ** $HSATIT,h.hhh,r.rrr,p.ppp,h.h,a.aaa,b.bbb,c.ccc,d.ddd,e.eee,f.fff,g.ggg,h.hhh,i.ii,j.jj,k.kk,l.ll,m.mm,n.nn<CR><LF> 50 50 ** 51 ** Field Number: 51 ** Field Number: 52 52 ** 1) h.hhh is the heading in deg 53 53 2) r.rrr is the roll in deg … … 68 68 17) m.mm is the east speed Std in m/s 69 69 18) n.nn is the vertical speed Std in m/s 70 71 70 71 72 72 */ 73 73 74 heading = sentence.Double( 1 ); 75 roll = sentence.Double( 2 ); 76 pitch = sentence.Double( 3 ); 77 heave = sentence.Double( 4 ); 78 yawRotationRate = sentence.Double( 5 ); 79 rollRotationRate = sentence.Double( 6 ); 74 heading = sentence.Double( 1 ); 75 roll = sentence.Double( 2 ); 76 pitch = sentence.Double( 3 ); 77 heave = sentence.Double( 4 ); 78 yawRotationRate = sentence.Double( 5 ); 79 rollRotationRate = sentence.Double( 6 ); 80 80 pitchRotationRate = sentence.Double( 7 ); 81 courseMadeGood = sentence.Double( 8 ); 81 courseMadeGood = sentence.Double( 8 ); 82 82 speedOverGround = sentence.Double( 9 ); 83 longitudinalVel = sentence.Double( 10 ); 83 longitudinalVel = sentence.Double( 10 ); 84 84 transveralVel = sentence.Double( 11 ); 85 85 verticalVel = sentence.Double( 12 ); … … 89 89 northSpeedStdDev = sentence.Double( 16 ); 90 90 eastSpeeedStdDev = sentence.Double( 17 ); 91 verticalStdDev = sentence.Double( 18 ); 91 verticalStdDev = sentence.Double( 18 ); 92 92 93 93 return( TRUE ); … … 108 108 ** Let the parent do its thing 109 109 */ 110 110 111 111 RESPONSE::Write( sentence ); 112 112 … … 115 115 sentence += pitch; 116 116 sentence += sentence += sentence += heave; 117 sentence += yawRotationRate; 118 sentence += rollRotationRate; 117 sentence += yawRotationRate; 118 sentence += rollRotationRate; 119 119 sentence += pitchRotationRate; 120 sentence += courseMadeGood; 120 sentence += courseMadeGood; 121 121 sentence += speedOverGround; 122 sentence += longitudinalVel; 122 sentence += longitudinalVel; 123 123 sentence += transveralVel; 124 124 sentence += verticalVel; … … 128 128 sentence += sentence += northSpeedStdDev; 129 129 sentence += eastSpeeedStdDev; 130 sentence += verticalStdDev; 130 sentence += verticalStdDev; 131 131 132 132 sentence.Finish(); … … 138 138 { 139 139 140 heading = source.heading; 141 roll = source.roll; 142 pitch = source.pitch; 143 heave = source.heave; 144 yawRotationRate = source.yawRotationRate; 145 rollRotationRate = source.rollRotationRate; 140 heading = source.heading; 141 roll = source.roll; 142 pitch = source.pitch; 143 heave = source.heave; 144 yawRotationRate = source.yawRotationRate; 145 rollRotationRate = source.rollRotationRate; 146 146 pitchRotationRate = source.pitchRotationRate; 147 courseMadeGood = source.courseMadeGood; 147 courseMadeGood = source.courseMadeGood; 148 148 speedOverGround = source.speedOverGround; 149 longitudinalVel = source.longitudinalVel; 149 longitudinalVel = source.longitudinalVel; 150 150 transveralVel = source.transveralVel; 151 151 verticalVel = source.verticalVel;
Note:
See TracChangeset
for help on using the changeset viewer.