gps_pvt 0.8.0 → 0.8.1

data/ext/ninja-scan-light/tool/swig/spec/GPS_spec.rb

@@ -765,9 +765,70 @@ __RINEX_CLK_TEXT__
       [:alpha, :beta].each{|k|
         puts "Iono #{k}: #{sn.iono_utc.send(k)}"
       }
+      proc{|raw|
+        expect(raw.size).to eq(10)
+        puts "Raw(IONO): #{raw.collect{|v| "0x%08X" % [v]}.join(', ')}"
+        iono2 = GPS::Ionospheric_UTC_Parameters::parse(raw)
+        [:alpha, :beta].collect{|f|
+          sn.iono_utc.send(f).zip(iono2.send(f))
+        }.flatten(1).zip([-30, -27, -24, -24, 11, 14, 16, 16]).each{|(a, b), sf|
+          expect(a).to be_within((2 ** sf) * 2).of(b)
+        }
+        [
+          [:A1, 2 ** -50], [:A0, 2 ** -30],
+        ].each{|k, sf|
+          #p [k, sf.to_f, sn.iono_utc.send(k) - iono2.send(k), sn.iono_utc.send(k), iono2.send(k)]
+          expect(sn.iono_utc.send(k)).to be_within((sf || 1).to_f * 2).of(iono2.send(k))
+        }
+      }.call(sn.iono_utc.dump(t_meas))
       
       meas.each{|prn, k, v|
         eph = sn.ephemeris(prn)
+        expect(eph.valid?(t_meas)).to eq(true)
+        sc2rad = 3.1415926535898
+        proc{|raw|
+          expect(raw.size).to eq(30)
+          eph2 = GPS::Ephemeris::new
+          raw.each_slice(10).with_index{|subframe, i|
+            puts "Raw(PRN:#{prn},SF:#{i+1}): #{subframe.collect{|v| "0x%08X" % [v]}.join(', ')}"
+            eph2.parse(subframe)
+          }
+          expect(eph.WN % 1024).to be(eph2.WN % 1024)
+          [
+            #:URA,
+            :SV_health, :iodc,
+            [:t_GD, 2 ** -31], [:t_oc, 2 ** 4], # SF1
+            [:a_f0, 2 ** -31], [:a_f1, 2 ** -43], [:a_f2, 2 ** -55], # SF1
+            :iode, # SF2
+            [:c_rs, 2 ** -5], [:delta_n, sc2rad * 2 ** -43], # SF2
+            [:M0, sc2rad * 2 ** -31], [:c_uc, 2 ** -29], [:e, 2 ** -33], # SF2
+            [:c_us, 2 ** -29], [:sqrt_A, 2 ** -19], [:t_oe, 2 ** 4], # SF2
+            :fit_interval, # SF2
+            [:c_ic, 2 ** -29], [:Omega0, sc2rad * 2 ** -31], [:c_is, 2 ** -29], # SF3
+            [:i0, sc2rad * 2 ** -31], [:c_rc, 2 ** -5], [:omega, sc2rad * 2 ** -31], # SF3
+            [:dot_Omega0, sc2rad * 2 ** -43], [:dot_i0, sc2rad * 2 ** -43], # SF3
+          ].each{|k, sf|
+            #p [k, sf.to_f, eph.send(k) - eph2.send(k), eph.send(k), eph2.send(k)]
+            expect(eph.send(k)).to be_within((sf || 1).to_f * 2).of(eph2.send(k))
+          }
+        }.call(eph.dump(t_meas))
+        proc{|raw| # Almanac -> Ephemeris
+          expect(raw.size).to eq(10)
+          puts "Raw(PRN:#{prn},Almanac): #{raw.collect{|v| "0x%08X" % [v]}.join(', ')}"
+          eph2 = GPS::Ephemeris::new
+          eph2.parse_almanac(raw)
+          [
+            :SV_health,
+            [:t_oc, 2 ** 12], [:a_f0, 2 ** -20], [:a_f1, 2 ** -38], 
+            [:M0, sc2rad * 2 ** -23], [:e, 2 ** -21],
+            [:sqrt_A, 2 ** -11], [:t_oe, 2 ** 12],
+            [:Omega0, sc2rad * 2 ** -23], [:i0, sc2rad * 2 ** -19],
+            [:omega, sc2rad * 2 ** -23], [:dot_Omega0, sc2rad * 2 ** -38],
+          ].each{|k, sf|
+            #p [k, sf.to_f, eph.send(k) - eph2.send(k), eph.send(k), eph2.send(k)]
+            expect(eph.send(k)).to be_within((sf || 1).to_f * 2).of(eph2.send(k))
+          }
+        }.call(eph.dump_almanac(t_meas))
         puts "XYZ(PRN:#{prn}): #{eph.constellation(t_meas)[0].to_a} (iodc: #{eph.iodc}, iode: #{eph.iode})"
       }
       

data/ext/ninja-scan-light/tool/util/bit_counter.h

@@ -0,0 +1,84 @@
+#ifndef __BIT_COUNTER__
+#define __BIT_COUNTER__
+
+#include <climits>
+
+using namespace std;
+
+/**
+ * Counting bits utility
+ */
+template <class T>
+struct BitCounter {
+
+  static const int num_of_bits = CHAR_BIT * sizeof(T);
+
+  private:
+    template <int Interval>
+    static T make_mask(){
+      /*
+       * @see http://www.nminoru.jp/~nminoru/programming/bitcount.html
+       * 
+       * 01010101010101010101010101010101  1 32
+       * 00110011001100110011001100110011  2 32
+       * 00001111000011110000111100001111  4 32
+       * 00000000111111110000000011111111  8 32
+       * 00000000000000001111111111111111 16 32 
+       */
+
+      T mask(1);
+      for(int i(1); i < Interval; i++){
+        mask <<= 1;
+        mask |= 0x01;
+      }
+      /*
+      // Equivalent to the following if T is built-in type
+      mask <<= Interval;
+      mask = (mask & (-mask)) - 1;
+      */ 
+
+      T res(mask);
+      for(unsigned int i(1); i < num_of_bits / Interval / 2; i++){
+        res <<= Interval;
+        res <<= Interval;
+        res |= mask;
+      }
+      return res;
+    }
+
+    template <int Interval, class U = void>
+    struct count_loop {
+      static T run(T bits){
+        bits = count_loop<(Interval >> 1)>::run(bits);
+        static const T mask(make_mask<Interval>());
+        // bit shift and add operators are required at least
+        return (bits & mask) + ((bits >> Interval) & mask);
+      }
+    };
+    template <class U>
+    struct count_loop<1, U> {
+      static T run(T bits){
+        static const T mask(make_mask<1>());
+        return (bits & mask) + ((bits >> 1) & mask);
+      }
+    };
+
+  public:
+    /**
+     * Count bits in a value
+     * @param results
+     */
+    static T count(const T &v) {
+      return count_loop<(num_of_bits >> 1)>::run(v);
+    }
+
+    /**
+     * Count rightmost zeros before the first one (Number of trailing zeros)
+     * @param bits results
+     */
+    static T ntz(const T &v) {
+      return count((T)((~v) & (v - 1)));
+    }
+};
+
+#endif /* __BIT_COUNTER__ */

data/lib/gps_pvt/receiver/extension.rb

@@ -0,0 +1,51 @@
+=begin
+Receiver extension
+=end
+
+module GPS_PVT
+class Receiver
+  
+  # shortcut to access ephemeris registered in receiver 
+  def ephemeris(t, sys, prn)
+    eph = case sys
+    when :GPS, :QZSS
+      critical{
+        @solver.gps_space_node.update_all_ephemeris(t)
+        @solver.gps_space_node.ephemeris(prn)
+      }
+    when :SBAS
+      critical{
+        @solver.sbas_space_node.update_all_ephemeris(t)
+        @solver.sbas_space_node.ephemeris(prn)
+      }
+    when :GLONASS
+      critical{
+        @solver.glonass_space_node.update_all_ephemeris(t)
+        @solver.glonass_space_node.ephemeris(prn)
+      }
+    else
+      return nil
+    end
+    return (eph.valid?(t) ? eph : nil)
+  end
+
+  def attach_online_ephemeris(uri_template = nil)
+    if (!uri_template) || (uri_template =~ /^\s*$/) then
+      uri_template = "ftp://gssc.esa.int/gnss/data/daily/%Y/brdc/BRDC00IGS_R_%Y%j0000_01D_MN.rnx.gz"
+    end
+    loader = proc{|t_meas|
+      utc = Time::utc(*t_meas.c_tm)
+      uri = URI::parse(utc.strftime(uri_template))
+      self.parse_rinex_nav(uri)
+      uri
+    }
+    run_orig = self.method(:run)
+    eph_list = {}
+    self.define_singleton_method(:run){|meas, t_meas, *args|
+      w_d = [t_meas.week, (t_meas.seconds.to_i / 86400)]
+      eph_list[w_d] ||= loader.call(t_meas)
+      run_orig.call(meas, t_meas, *args)
+    }
+  end
+end
+end

data/lib/gps_pvt/receiver.rb

@@ -3,7 +3,7 @@ Receiver class to be an top level interface to a user
 (The origin is ninja-scan-light/tool/misc/receiver_debug.rb)
 =end
 
-require_relative 'GPS'
+require 'gps_pvt/GPS' # in case GPS.so is generated under ext/gps_pvt
 require_relative 'util'
 
 module GPS_PVT
@@ -523,6 +523,8 @@ class Receiver
             v
           }
           sys, svid = gnss_serial.call(*loader.call(36, 2).reverse)
+          # sigID check to restrict signal to L1 if version(>0); @see UBX-18010854
+          next if (packet[6 + 13] != 0) && (loader.call(38, 1, "C") != 0)
           case sys
           when :GPS, :SBAS, :QZSS;
           when :GLONASS
@@ -556,10 +558,13 @@ class Receiver
         register_ephemeris(
             t_meas,
             sys, svid,
-            packet.slice(6 + 2, 40).each_slice(4).collect{|v|
-              res = v.pack("C*").unpack("V")[0]
-              (sys == :GPS) ? ((res & 0xFFFFFF) << 6) : res
-            })
+            proc{|data|
+              case sys # adjust padding
+              when :GPS; data.collect!{|v| (v & 0xFFFFFF) << 6}
+              when :SBAS; data[7] <<= 6
+              end
+              data
+            }.call(packet.slice(6 + 2, 40).pack("C*").unpack("V*")))
       when [0x02, 0x13] # RXM-SFRBX
         sys, svid = gnss_serial.call(packet[6 + 1], packet[6])
         opt = {}
@@ -567,9 +572,7 @@ class Receiver
         register_ephemeris(
             t_meas,
             sys, svid,
-            packet.slice(6 + 8, 4 * packet[6 + 4]).each_slice(4).collect{|v|
-              v.pack("C*").unpack("V")[0]
-            }, opt)
+            packet.slice(6 + 8, 4 * packet[6 + 4]).pack("C*").unpack("V*"), opt)
       end
     }
     $stderr.puts ", found packets are %s"%[ubx_kind.inspect]
@@ -696,3 +699,5 @@ class Receiver
   end
 end
 end
+
+require_relative 'receiver/extension'

data/lib/gps_pvt/version.rb

@@ -1,5 +1,5 @@
 # frozen_string_literal: true
 
 module GPS_PVT
-  VERSION = "0.8.0"
+  VERSION = "0.8.1"
 end

metadata

@@ -1,14 +1,14 @@
 --- !ruby/object:Gem::Specification
 name: gps_pvt
 version: !ruby/object:Gem::Version
-  version: 0.8.0
+  version: 0.8.1
 platform: ruby
 authors:
 - fenrir(M.Naruoka)
 autorequire: 
 bindir: exe
 cert_chain: []
-date: 2022-09-13 00:00:00.000000000 Z
+date: 2022-11-17 00:00:00.000000000 Z
 dependencies:
 - !ruby/object:Gem::Dependency
   name: rubyserial
@@ -112,11 +112,13 @@ files:
 - ext/ninja-scan-light/tool/swig/makefile
 - ext/ninja-scan-light/tool/swig/spec/GPS_spec.rb
 - ext/ninja-scan-light/tool/swig/spec/SylphideMath_spec.rb
+- ext/ninja-scan-light/tool/util/bit_counter.h
 - ext/ninja-scan-light/tool/util/text_helper.h
 - gps_pvt.gemspec
 - gps_pvt.rbs
 - lib/gps_pvt.rb
 - lib/gps_pvt/receiver.rb
+- lib/gps_pvt/receiver/extension.rb
 - lib/gps_pvt/ubx.rb
 - lib/gps_pvt/util.rb
 - lib/gps_pvt/version.rb