nabaztag_hack_kit 0.0.2

data/ext/mtl/vnet.c

@@ -0,0 +1,255 @@
+// VLISP Virtual Machine - 2006 - by Sylvain Huet
+// Lowcost IS Powerfull
+#include"vmem.h"
+#include"properties.h"
+
+#ifdef VSIMU
+#include <string.h>
+#include<stdio.h>
+#include<time.h>
+#include "log.h"
+int netstatesimu=1;
+#endif
+#ifdef VREAL
+#include "rt2501usb.h"
+#endif
+#include"vloader.h"
+#include"vnet.h"
+#include"vlog.h"
+#include"vinterp.h"
+int netState()
+{
+#ifdef VSIMU
+        return netstatesimu;
+#endif
+#ifdef VREAL
+      return rt2501_state();
+#endif
+}
+
+int netSend(char* src,int indexsrc,int lentosend,int lensrc,char* macdst,int inddst,int lendst,int speed)
+{
+#ifdef VSIMU
+        my_printf(LOG_SIMUNET, "xxxx netSend\n");
+		return -1;
+#endif
+#ifdef VREAL
+  if (indexsrc<0) return -1;
+  if (indexsrc+lentosend>lensrc) lentosend=lensrc-indexsrc;
+  if (lentosend<=0) return -1;
+  if (inddst<0) return -1;
+  if (inddst+6>lendst) return -1;
+  return rt2501_send((const unsigned char *)(src+indexsrc),lentosend,(const unsigned char *)(macdst+inddst),speed,1);
+#endif
+}
+
+int netCb(char* src,int lensrc,char* macsrc)
+{
+  VPUSH(PNTTOVAL(VMALLOCSTR(src,lensrc)));
+  VPUSH(PNTTOVAL(VMALLOCSTR(macsrc,6)));
+  VPUSH(VCALLSTACKGET(sys_start,SYS_CBTCP));
+  if (VSTACKGET(0)!=NIL) interpGo();
+  else { VPULL();VPULL();}
+  VPULL();
+  return 0;
+}
+
+extern unsigned char rt2501_mac[6];
+
+#ifdef VSIMU
+int htoi2(char* src)
+{
+	char buf[3];
+	buf[0]=src[0];
+	buf[1]=src[1];
+	buf[2]=0;
+	return sysHtoi(buf);
+}
+#endif
+
+char mac[6];
+
+char* netMac()
+{
+#ifdef VSIMU
+	int i;
+	char *p=PropGet("MAC");
+	for(i=0;i<6;i++) mac[i]=htoi2(&p[i*2]);
+	return mac;
+//	return "abcdef";
+#endif
+#ifdef VREAL
+  return (char*) rt2501_mac;
+#endif
+}
+
+int netChk(char* src,int indexsrc,int lentosend,int lensrc,unsigned int val)
+{
+  unsigned short* p;
+
+  if (indexsrc<0) return val;
+  if (indexsrc+lentosend>lensrc) lentosend=lensrc-indexsrc;
+  if (lentosend<=0) return val;
+
+  src+=indexsrc;
+  p=(unsigned short*)src;
+
+  val=((val<<8)&0xff00)+((val>>8)&0xff);
+  while(lentosend>1)
+  {
+	  val+=*(p++);
+	  lentosend-=2;
+  }
+  if (lentosend) val+=*(unsigned char*)p;
+
+  val=(val>>16)+(val&0xffff);
+  val=(val>>16)+(val&0xffff);
+  val=((val<<8)&0xff00)+((val>>8)&0xff);
+  return val;
+}
+
+void netSetmode(int mode,char* ssid,int chn)
+{
+#ifdef VSIMU
+        my_printf(LOG_SIMUNET, "xxxx netSetmode %d %s %d\n",mode,ssid,chn);
+		netstatesimu=(mode)?5:4;
+#endif
+#ifdef VREAL
+  rt2501_setmode(mode,ssid,chn);
+#endif
+}
+
+
+int nscan;
+#ifdef VREAL
+void netScan_(struct rt2501_scan_result *scan_result, void *userparam)
+{
+  char buf[256];
+  sprintf(buf,">>> %s %d %d %d %d\n",scan_result->ssid,scan_result->rssi,scan_result->channel,scan_result->rateset,scan_result->encryption);
+  consolestr((UBYTE*)buf);
+  VPUSH(PNTTOVAL(VMALLOCSTR(scan_result->ssid,strlen(scan_result->ssid))));
+  VPUSH(PNTTOVAL(VMALLOCSTR((char*)scan_result->mac,6)));
+  VPUSH(PNTTOVAL(VMALLOCSTR((char*)scan_result->bssid,6)));
+  VPUSH(INTTOVAL(scan_result->rssi));
+  VPUSH(INTTOVAL(scan_result->channel));
+  VPUSH(INTTOVAL(scan_result->rateset));
+  VPUSH(INTTOVAL(scan_result->encryption));
+  VMKTAB(7);
+  nscan++;
+}
+#endif
+
+void netScan(char* ssid)
+{
+  nscan=0;
+#ifdef VSIMU
+  VPUSH(PNTTOVAL(VMALLOCSTR("foo",3)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("xyzxyz",6)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("765432",6)));
+  VPUSH(INTTOVAL(-20));
+  VPUSH(INTTOVAL(11));
+  VPUSH(INTTOVAL(1));
+  VPUSH(INTTOVAL(0));
+  VMKTAB(7);
+  nscan++;
+  VPUSH(PNTTOVAL(VMALLOCSTR("foo",3)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("xyzxyz",6)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("765432",6)));
+  VPUSH(INTTOVAL(-10));
+  VPUSH(INTTOVAL(11));
+  VPUSH(INTTOVAL(1));
+  VPUSH(INTTOVAL(0));
+  VMKTAB(7);
+  nscan++;
+  VPUSH(PNTTOVAL(VMALLOCSTR("zzzz",3)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("xyzxyz",6)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("765432",6)));
+  VPUSH(INTTOVAL(-10));
+  VPUSH(INTTOVAL(11));
+  VPUSH(INTTOVAL(1));
+  VPUSH(INTTOVAL(0));
+  VMKTAB(7);
+  nscan++;
+  VPUSH(PNTTOVAL(VMALLOCSTR("",3)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("xyzxyz",6)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("765432",6)));
+  VPUSH(INTTOVAL(-10));
+  VPUSH(INTTOVAL(11));
+  VPUSH(INTTOVAL(1));
+  VPUSH(INTTOVAL(0));
+  VMKTAB(7);
+  nscan++;
+  VPUSH(PNTTOVAL(VMALLOCSTR("a\"a<a'a  a\\a",strlen("a\"a<a'a  a\\a"))));
+  VPUSH(PNTTOVAL(VMALLOCSTR("xyzxyz",6)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("765432",6)));
+  VPUSH(INTTOVAL(-10));
+  VPUSH(INTTOVAL(11));
+  VPUSH(INTTOVAL(1));
+  VPUSH(INTTOVAL(3));
+  VMKTAB(7);
+  nscan++;
+  VPUSH(PNTTOVAL(VMALLOCSTR("foo",3)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("xyzxyz",6)));
+  VPUSH(PNTTOVAL(VMALLOCSTR("765432",6)));
+  VPUSH(INTTOVAL(-30));
+  VPUSH(INTTOVAL(11));
+  VPUSH(INTTOVAL(1));
+  VPUSH(INTTOVAL(0));
+  VMKTAB(7);
+  nscan++;
+#endif
+#ifdef VREAL
+  rt2501_scan(ssid, netScan_, NULL);
+#endif
+  VPUSH(NIL);
+  while(nscan--) VMKTAB(2);
+}
+
+void netAuth(char* ssid,char* mac,char* bssid,int chn,int rate,int authmode,int encrypt,char* key)
+{
+#ifdef VSIMU
+        my_printf(LOG_SIMUNET, "xxxx netAuth %s %d %d %d %d\n",ssid,chn,rate,authmode,encrypt);
+		netstatesimu=4;
+#endif
+#ifdef VREAL
+  rt2501_auth((const char*)ssid,(const unsigned char*)mac,(const unsigned char*)bssid,chn,rate,authmode,encrypt,(const unsigned char*)key);
+#endif
+}
+
+void netSeqAdd(unsigned char* seq,int n)
+{
+  unsigned char res[4];
+  unsigned int val;
+  val=(seq[0]<<24)+(seq[1]<<16)+(seq[2]<<8)+seq[3];
+  val+=n;
+  res[3]=val; val>>=8;
+  res[2]=val; val>>=8;
+  res[1]=val; val>>=8;
+  res[0]=val;
+  VPUSH(PNTTOVAL(VMALLOCSTR((char*)res,4)));
+}
+
+void mypassword_to_pmk(const char *password, char *ssid, int ssidlength, unsigned char *pmk);
+
+void netPmk(char* ssid,char* key,char* buf)
+{
+#ifdef VSIMU
+	my_printf(LOG_SIMUNET, "xxxx netPmk %s %s\n",ssid,key);
+	strcpy(buf,"01234567012345670123456701234567");
+#endif
+#ifdef VREAL
+//      strcpy(buf,"01234567012345670123456701234567");
+      mypassword_to_pmk(key,ssid,strlen(ssid), (unsigned char*)buf);
+#endif
+}
+
+int netRssi()
+{
+#ifdef VSIMU
+	return -20;
+#endif
+#ifdef VREAL
+	return rt2501_rssi_average();
+#endif
+}
+

data/ext/mtl/vnet.h

@@ -0,0 +1,19 @@
+// VLISP Virtual Machine - 2006 - by Sylvain Huet
+// Lowcost IS Powerfull
+
+#ifndef _NET_
+#define _NET_
+
+int netState();
+int netSend(char* src,int indexsrc,int lentosend,int lensrc,char* macdst,int inddst,int lendst,int speed);
+int netCb(char* src,int lensrc,char* macsrc);
+char* netMac();
+int netChk(char* src,int indexsrc,int lentosend,int lensrc,unsigned int val);
+void netSetmode(int mode,char* ssid,int chn);
+void netScan(char* ssid);
+void netAuth(char* ssid,char* mac,char* bssid,int chn,int rate,int authmode,int encrypt,char* key);
+void netSeqAdd(unsigned char* seq,int n);
+void netPmk(char* ssid,char* key,char* buf);
+int netRssi();
+#endif
+

data/lib/nabaztag_hack_kit/message/api.rb

@@ -0,0 +1,39 @@
+module NabaztagHackKit
+  module Message
+    module Api
+      # 0 - 10 reserved for violet backwards compatibility
+
+      OK     = 12
+      INIT   = 16
+      LOG    = 17
+      ERROR  = 18
+      REBOOT = 19
+
+      LED_0  = 20
+      LED_1  = 21
+      LED_2  = 22
+      LED_3  = 23
+      LED_4  = 24
+      LED_L0 = 25
+      LED_L1 = 26
+      LED_L2 = 27
+      LED_L3 = 28
+      LED_L4 = 29
+
+      EAR_L  = 40
+      EAR_R  = 41
+      EAR_LL = 42
+      EAR_LR = 43
+
+      F = 1
+      B = 2
+
+      def rgb(values)
+        values.map do |value|
+          Message.to_3b(value)
+        end.flatten
+      end
+
+    end
+  end
+end

data/lib/nabaztag_hack_kit/message/helper.rb

@@ -0,0 +1,39 @@
+module NabaztagHackKit
+  module Message
+    module Helper
+      #blink
+      def bl(loops = 1, color_on = 0xFF, color_off = 0x00)
+        repeat(loops, [color_on, color_off])
+      end
+
+      #repeat
+      def rp(loops, pattern = 0)
+        Array.new(loops, pattern).flatten
+      end
+      alias_method :sl, :rp #sleep
+
+      #knight rider
+      def kr(color = 0xFF, led1 = Api::LED_L1, led2 = Api::LED_L2, led3 = Api::LED_L3)
+        {
+          led1 => [color,0,0,0],
+          led2 => [0,color],
+          led3 => [0,0,color,0]
+        }
+      end
+
+      def fire(color = 0x110000, led1 = Api::LED_L1, led2 = Api::LED_L2, led3 = Api::LED_L3)
+        data = Array.new(16) do |i|
+          Message.to_3b(i * color)
+        end + Array.new(8) do |i|
+          Message.to_3b((15-i) * 2 * color)
+        end
+
+        {
+          (led1+10) => data + [0,0,0] + [0,0,0],
+          (led2+10) => [0,0,0] + data + [0,0,0],
+          (led3+10) => [0,0,0] + [0,0,0] + data
+        }
+      end
+    end
+  end
+end

data/lib/nabaztag_hack_kit/message.rb

@@ -0,0 +1,36 @@
+module NabaztagHackKit
+  module Message
+
+    def build(*commands)
+      commands = if commands.first.is_a?(Hash)
+        commands.first
+      elsif !commands.first.is_a?(Array)
+        [commands]
+      else
+        commands
+      end
+
+      pack full_message commands.map { |cmd, *data|
+        [cmd] + to_3b(data.flatten.size) + data.flatten
+      }
+    end
+    module_function(:build)
+
+    def to_3b(int)
+      [int >> 16, int >> 8, int].map { |i| i & 0xFF }
+    end
+    module_function(:to_3b)
+
+    private
+    def full_message(*data)
+      [0x7F] + data.flatten + [0xFF, 0x0A]
+    end
+    module_function(:full_message)
+
+    def pack(message)
+      message.pack('c*')
+    end
+    module_function(:pack)
+  end
+
+end

data/lib/nabaztag_hack_kit/server.rb

@@ -0,0 +1,50 @@
+require 'sinatra/base'
+
+require 'nabaztag_hack_kit/message'
+require 'nabaztag_hack_kit/message/api'
+
+module NabaztagHackKit
+  class Server < Sinatra::Base
+    include Message::Api
+
+    def initialize(bytecode_path = nil)
+      super
+      @bytecode_path = bytecode_path || File.join('public', 'bytecode.bin')
+    end
+
+    def send_nabaztag(*data)
+      Message.build(*data)
+    end
+
+    def parse_log(logs)
+      logs.to_s.split("|").map do |line|
+        type, time, *values = line.split(",")
+        time = time.to_i
+        values = values.map &:to_i
+
+        if type == "moved"
+          values << (time - values[1]) << (values[1] - values[2]) << (time - values[2]) << (time - values[3])
+        end
+        "#{type}-#{time}: #{values.join("\t")}"
+      end
+    end
+
+    get '/bc.jsp' do
+      # TODO recompile if changed
+      send_file @bytecode_path
+    end
+
+    get '/vl/button.jsp' do
+      send_nabaztag EAR_L => [12,0,16,0,16,0,16,0]
+    end
+
+    post '/vl/log.jsp' do
+      @logs = parse_log params[:logs]
+      puts "#########################"
+      puts @logs.join("\n")
+      puts "#########################"
+      send_nabaztag OK
+    end
+  end
+
+end

data/lib/nabaztag_hack_kit/version.rb

@@ -0,0 +1,3 @@
+module NabaztagHackKit
+  VERSION = "0.0.2"
+end

data/lib/nabaztag_hack_kit.rb

@@ -0,0 +1,4 @@
+require "nabaztag_hack_kit/version"
+
+module NabaztagHackKit
+end

data/nabaztag_hack_kit.gemspec

@@ -0,0 +1,29 @@
+# -*- encoding: utf-8 -*-
+$:.push File.expand_path("../lib", __FILE__)
+require "nabaztag_hack_kit/version"
+
+Gem::Specification.new do |s|
+  s.name        = "nabaztag_hack_kit"
+  s.version     = NabaztagHackKit::VERSION
+  s.authors     = ["RngTng - Tobias Bielohlawek"]
+  s.email       = ["tobi@soundcloud.com"]
+  s.homepage    = "https://github.com/rngtng/nabaztag_hack_kit"
+  s.summary     = %q{Sinatra server to run custom Nabaztag bytecode}
+  s.description = %q{Sinatra server api framework to run custom bytecode on Nabaztag v1/v2. Sources + Compiler included (linux only)}
+
+  s.files         = `git ls-files`.split("\n")
+  s.test_files    = `git ls-files -- {test,spec,features}/*`.split("\n")
+  s.executables   = `git ls-files -- bin/*`.split("\n").map{ |f| File.basename(f) }
+  s.extensions    = ['ext/mtl/extconf.rb']
+  s.executables   = ['mtl_comp', 'mtl_simu', 'mtl_merge']
+
+  s.require_paths = ["lib"]
+
+  ["sinatra"].each do |gem|
+    s.add_dependency *gem.split(' ')
+  end
+
+  ["rake", "rspec"].each do |gem|
+    s.add_development_dependency *gem.split(' ')
+  end
+end

data/test/bytecode/helper.mtl

@@ -0,0 +1,60 @@
+//----- asserts
+fun test name=
+  SLecholn "\n"::name::": "::nil
+;;
+
+fun ok should=
+  SLecholn "  "::should::" is valid"::nil
+;;
+
+fun failed should is=
+  SLecholn "!! "::"  "::should::" expected but got "::is::nil
+;;
+
+fun assert_nil should=
+  if(should == nil) then
+    ok ""
+  else
+    failed "nil" "not nil"
+;;
+
+fun assert_equal should=
+  if(should == 1) then
+    ok ""
+  else
+    failed "true" "false"
+;;
+
+fun assert_not_equal should=
+  if(should != 1) then
+    ok ""
+  else
+    failed "false" "true"
+;;
+
+fun assert_equalI should is=
+  if(should == is) then
+    ok itoa should
+  else
+    failed itoa should itoa is
+;;
+
+fun assert_equalS should is=
+  let strcat should "\v" -> shouldn in
+  if(strcmp should is) == 0 then
+    ok should
+  else
+    failed should is
+;;
+
+fun assert_equalIL should is=
+  assert_equalS listtostr should listtostr is
+;;
+
+fun assert_equalSL should is=
+  assert_equalS strcatlist should strcatlist is
+;;
+
+fun assert_equalTL should is=
+  assert_equalS TLtoS should TLtoS is
+;;

data/test/bytecode/native.mtl

@@ -0,0 +1,28 @@
+//-------- test for native function
+
+let test "listlen" -> t in
+(
+  assert_equalI 0        listlen nil ;
+  assert_equalI 1        listlen "test"::nil
+);
+
+let test "listtostr" -> t in
+(
+  assert_equalS "\49"  listtostr 49::nil;
+  assert_equalS "\51\52\53"  listtostr 51::52::53::nil
+);
+
+let test "strcatlist" -> t in
+(
+  assert_equalS "\54"  strcatlist "\54"::nil;
+  assert_equalS "313233"  strcatlist "31"::"32"::"33"::nil
+);
+
+// remfromlist same as  listrem!!!
+//let test "remfromlist" -> t in
+//(
+//  let "asd"::"a"::nil -> l in
+//  Lecho (remfromlist l (listlen l) - 1)
+//  //assert_equalS "0A000"
+//    assert_equalL 48::49::50::nil listrem 48::49::50::nil 49
+//);