diff options
Diffstat (limited to 'src/feature.cpp')
| -rw-r--r-- | src/feature.cpp | 11 |
1 files changed, 10 insertions, 1 deletions
diff --git a/src/feature.cpp b/src/feature.cpp index 4db6a29..94183ab 100644 --- a/src/feature.cpp +++ b/src/feature.cpp @@ -993,7 +993,7 @@ Feature::P0 ( measurement_type t ) *-------------------------------------------------------------------------------------- */ UTM -Feature::utm ( Vector3d &xbw, Quaterniond &q ) +Feature::utm ( const Vector3d &xbw, const Quaterniond &q ) { UTM utm; Vector3d xib,xiw; @@ -1159,3 +1159,12 @@ Feature::since ( int N ) const return (lastseen<N) ; } /* ----- end of method Feature::since ----- */ +void +Feature::unicsv(const double time, const Vector3d &xbw, const Quaterniond &qbw) +{ + UTM feature_utm = utm(xbw,qbw); + printf("%d,%f,%d,%c,%f,%f,%f,0,0,0,0,0,0,0\n", id(),time,feature_utm.zone_i, + feature_utm.zone_c, feature_utm.northing, feature_utm.easting, + feature_utm.up); +} + |