p3 0.0.1 → 0.0.2

checksums.yaml

@@ -1,7 +1,7 @@
 ---
 SHA1:
-  metadata.gz: 16ce329ad2b6feeaf74bddc1e3d724f33d0dd4a7
-  data.tar.gz: 5149473c7dcea16ed55a4b030b9871fe7684641e
+  metadata.gz: b7eb67b801a8b88a152d7a5a0d5b0266c4a3ee38
+  data.tar.gz: 4dfcd78e495231a0ba38a2d74d6da1c5d2b70beb
 SHA512:
-  metadata.gz: 507cccca935c32b2460b4105f196ad0138c82a94f4813f6204ee7a13d3f223ef84b3023606a327cea6f1550a2fb05283a1320d3bbb51c6ce1bdb4296f48d38a0
-  data.tar.gz: 07ea979133ba9455b29a709678db05a774f880bf6c9c78e20cf0b2a9cf4aa3ef12ea0a6c87ce11d2d42be815250173ad7714b530b794859f7583254d11fa7134
+  metadata.gz: 6f26b62209d05fa4264c3f98234f4457bad5164f2412a777e6c19dd8ae52a30adb5960fd39f5d6be5c4aa9fca41d01d751c067631b3dcd50abbfb9ad4c1a6f95
+  data.tar.gz: 9923ae7b08f012316bd25882739de4b3efe010a3d0e459827ef6712c0327d4e8e610ed2738041b54bf5824e3334b73eafbe1fb73582848f97ca26e2c0f26e463

data/lib/p3.rb

@@ -1 +1,179 @@
+#!/usr/bin/env ruby
+#encoding: UTF-8
 
+require "pp"
+require 'socket'
+
+class P3
+
+  P3_START='~'.ord
+  P3_END='~'.ord
+  P3_ESC='#'.ord
+
+  def initialize(hash={},&block)
+    @p3mode=false
+    @p3start=0
+    @p3buf=[]
+    @p3esc=false
+    @clients={}
+    @block=block
+  end
+
+  def unpack buf #buils object from packet byte array
+    blen=buf.size
+    #puts "GOT: buf<#{buf}> buflen=#{buf.size}"
+    return if blen<4
+    check2=0
+    buf[0...blen-1].each do |b|
+      check2^=b
+    end
+    i=0
+    proto=buf[i].chr
+    i+=1
+    mac=sprintf "%02X:%02X",buf[i],buf[i+1]
+    i+=4
+    ip=sprintf "%d.%d.%d.%d",buf[i+3],buf[i+2],buf[i+1],buf[i]
+    i+=4
+    port=buf[i]*0x100+buf[i+1]
+    i+=2
+    len=buf[i]
+    i+=1
+    check=buf[i+len]
+    data=buf[i...i+len]
+    pac={
+      proto:proto,
+      mac: mac,
+      ip: ip,
+      port:port,
+      data:data,
+    }
+    #puts "proto=#{proto},mac=#{mac},ip=#{ip},socket=#{socket},len=#{len},check=#{check}==#{check2},data='#{data.pack("C*")}'"
+  end
+
+
+
+  def pack pac #builds p3 packet from  pac object
+    #pp pac
+    begin
+      buf=[]
+      buf<<pac[:proto].ord
+      macs=pac[:mac].split(":")
+      buf<<macs[0].to_i(16)
+      buf<<macs[1].to_i(16)
+      buf<<0
+      buf<<0
+      ips=pac[:ip].split(".")
+      buf<<ips[3].to_i
+      buf<<ips[2].to_i
+      buf<<ips[1].to_i
+      buf<<ips[0].to_i
+      buf<<pac[:port]/0x100
+      buf<<(pac[:port]&0xff)
+      buf<<pac[:data].size
+      buf+=pac[:data].unpack("C*")
+      check=0
+      buf.each do |b|
+        check^=b
+      end
+      buf<<check
+      #pp buf
+      #pp "~#{buf.pack("C*")}~"
+      return "~#{buf.pack("C*")}~"
+    rescue => e
+      p e
+      p e.backtrace
+    end
+    return nil
+  end
+
+  def p3_packet_in buf
+    #puts "packet in #{buf}"
+    pac= unpack buf
+    return if not pac
+    pp pac
+    pp @clients
+    if pac[:proto]=="U"
+      if not @clients[pac[:mac]]
+        puts "new client #{pac[:mac]}"
+        @clients[pac[:mac]]={socket: UDPSocket.new,created:Time.now,count_r:0, count_s:0}
+        @clients[pac[:mac]][:thread]=Thread.new(pac[:mac]) do |my_mac|
+          loop do
+            begin
+              r,stuff=@clients[my_mac][:socket].recvfrom(2000) #get_packet --high level func!
+              ip=stuff[2]
+              port=stuff[1]
+              #puts "got reply '#{r}' from server #{ip}:#{port} to our mac #{my_mac}"
+              pac={
+                proto:'U',
+                mac: my_mac,
+                ip: ip,
+                port:port,
+                data:r,
+              }
+              #pp pac
+              # received return packet from server!
+              if @block
+                @block.call pac
+              end
+              #$sp.write pack pac
+              @clients[my_mac][:last_r]=Time.now
+              @clients[my_mac][:count_r]+=1
+             rescue => e
+              puts "thread dies..."
+              p e
+              p e.backtrace
+            end
+          end
+        end
+        pp @clients
+      end
+      @clients[pac[:mac]][:socket].send(pac[:data].pack("C*"), 0, pac[:ip], pac[:port])
+      _,port,_,_ = @clients[pac[:mac]][:socket].addr
+      @clients[pac[:mac]][:gw_port]=port
+      @clients[pac[:mac]][:last_s]=Time.now
+      @clients[pac[:mac]][:count_s]+=1
+      pp @clients
+    end
+  end
+
+  def shutdown
+    @clients.each do |k,c|
+      if c[:socket]
+        c[:socket].close
+        puts "closed #{k}: #{c[:socket]}"
+      end
+      if c[:thread]
+        c[:thread].kill
+        puts "killed #{k}: #{c[:thread]}"
+      end
+    end
+    @clients={}
+  end
+
+  def inchar ch
+    #puts "got:#{ch}"
+    if ch==P3_START and not @p3esc and not @p3mode
+      @p3mode=true
+      @p3start=Time.now
+      @p3buf=[]
+    elsif ch==P3_END and not @p3esc and @p3mode
+      @p3mode=false
+      p3_packet_in @p3buf
+      @p3buf=[]
+    else
+      if not @p3mode
+        return false #not done, please process .. show to user
+      else
+        if @p3esc
+          @p3esc=false
+        elsif ch==P3_ESC
+          @p3esc=true
+          return
+        end
+        @p3buf<<ch
+      end
+    end
+    return true #char was done -- do not process
+  end
+
+end

metadata

@@ -1,7 +1,7 @@
 --- !ruby/object:Gem::Specification
 name: p3
 version: !ruby/object:Gem::Version
-  version: 0.0.1
+  version: 0.0.2
 platform: ruby
 authors:
 - Ari Siitonen