Forked from:: mash's FLARToolKit SimpleCube sample

FLARToolKit use flash.geom package test

from flartoolkit SimpleCube example
print this marker: http://saqoosha.net/lab/FLARToolKit/flarlogo-marker.pdf
flash.geom.* でFLAR使うテスト。あってるかな、、
座標系まちごうとったから変えた

nutsu

forked:4
favorite:16
lines:163
license : see code comments
modified : 2010-05-26 14:37:25

Embed: Tweet

// forked from mash's FLARToolKit SimpleCube sample
// from flartoolkit SimpleCube example
// print this marker: http://saqoosha.net/lab/FLARToolKit/flarlogo-marker.pdf
//flash.geom.* でFLAR使うテスト。あってるかな、、
//座標系まちごうとったから変えた
package  
{
	import flash.display.Graphics;
	import flash.display.Shape;
	import flash.display.Sprite;
	import flash.events.Event;
	import flash.geom.Matrix3D;
	import flash.geom.Utils3D;
	import org.libspark.flartoolkit.core.FLARMat;
	import org.libspark.flartoolkit.core.param.FLARParam;
	import org.libspark.flartoolkit.core.transmat.FLARTransMatResult;
	import org.libspark.flartoolkit.core.types.FLARIntSize;
	import org.libspark.flartoolkit.example.ARAppBase;
	
	[SWF( width=640, height=480, frameRate=30, backgroundColor=0 )]
	public class ARTest extends ARAppBase
	{
		private var _base:Sprite;
		private var _view:Shape;
		private var g:Graphics;
		
		//
		private var _rmat:FLARTransMatResult = new FLARTransMatResult();
		private var _fr_mat:Matrix3D;
		private var _de_mat:Matrix3D;
		
		//
		private var _mat:Matrix3D;
		private var vert1:Vector.<Number>;
		private var uvt1:Vector.<Number>;
		private var vert2:Vector.<Number>;
		private var uvt2:Vector.<Number>;
		private var vout:Vector.<Number>;
		//
		private var projmat:Matrix3D;
		
		public function ARTest() 
		{
			Wonderfl.capture_delay( 5 );
			addEventListener(Event.INIT, _onInit);
            init('http://assets.wonderfl.net/static/flar/camera_para.dat', 'http://assets.wonderfl.net/static/flar/flarlogo.pat');
		}
		
		private function _onInit(e:Event):void 
		{
			addChild( _base = new Sprite() );
			
			//
			_capture.width = 640;
			_capture.height = 480;
			_base.addChild(_capture);
			//
			g = Shape(addChild( _view = new Shape() )).graphics;
			_view.x = 320;
			_view.y = 240;
			_view.scaleX = _view.scaleY = 2;
			//
			_fr_mat = new Matrix3D();
			_de_mat = new Matrix3D();
			initCamera( this._param );
			
			//
			projmat = new Matrix3D();
			initARObjects();
			
			//
			stage.addEventListener(Event.ENTER_FRAME, _onEnterFrame);
        }
		
		private function initARObjects():void
		{
			// Create Plane with same size of the marker.
            vert1 = new Vector.<Number>();
			uvt1  = new Vector.<Number>();
			var w:Number = 40;
			vert1.push( 0, 0, 0, 
						-w, -w, 0, w, -w, 0, w, w, 0, -w, w, 0,
						w, 0, 0, 0, w, 0, 0, 0, w );
			for ( var i:int = 0; i < vert1.length; i++ ) {
				uvt1.push( 0 );
			}
			
			//cube
			vert2 = new Vector.<Number>();
			uvt2  = new Vector.<Number>();
			w /= 2;
			vert2.push( -w, -w, -w,   w, -w, -w,   w, w, -w,   -w, w, -w,
						-w, -w,  w,   w, -w,  w,   w, w,  w,   -w, w,  w );
			for ( i = 0; i < vert1.length; i++ ) {
				uvt1.push( 0 );
			}
			
			//
			_mat = new Matrix3D();
			//
			vout = new Vector.<Number>();
		}
		
		private function drawObjects():void
		{
			g.clear();
			
			vout.length = 0;
			Utils3D.projectVectors( projmat, vert1, vout, uvt1 );
			g.lineStyle( 2, 0xffffff );
			g.beginFill( 0xff0000, 0.2 );
			quad( vout[2], vout[3], vout[4], vout[5], vout[6], vout[7], vout[8], vout[9] );
			g.endFill();
			//x axis
			g.lineStyle( 2, 0xff0000 );
			line( vout[0], vout[1], vout[10], vout[11] );
			//y axis
			g.lineStyle( 2, 0x0000ff );
			line( vout[0], vout[1], vout[12], vout[13] );
			//z axis
			g.lineStyle( 2, 0x00ff00 );
			line( vout[0], vout[1], vout[14], vout[15] );
			
			//cube
			_mat.identity();
			_mat.appendTranslation( 0, 0, 20 );
			var vert2t:Vector.<Number> = new Vector.<Number>();
			_mat.transformVectors( vert2, vert2t );
			vout.length = 0;
			Utils3D.projectVectors( projmat, vert2t, vout, uvt2 );
			g.lineStyle( 1, 0xffffff );
			quad( vout[0], vout[1], vout[2], vout[3], vout[4], vout[5], vout[6], vout[7] );
			quad( vout[8], vout[9], vout[10], vout[11], vout[12], vout[13], vout[14], vout[15] );
			line( vout[0], vout[1], vout[8], vout[9] );
			line( vout[2], vout[3], vout[10], vout[11] );
			line( vout[4], vout[5], vout[12], vout[13] );
			line( vout[6], vout[7], vout[14], vout[15] );
			
		}
		
		private function line( x0:Number, y0:Number, x1:Number, y1:Number ):void
		{
			g.moveTo( x0, y0 );
			g.lineTo( x1, y1 );
		}
		
		private function quad( x0:Number, y0:Number, x1:Number, y1:Number, x2:Number, y2:Number, x3:Number, y3:Number ):void
		{
			g.moveTo( x0, y0 );
			g.lineTo( x1, y1 );
			g.lineTo( x2, y2 );
			g.lineTo( x3, y3 );
			g.lineTo( x0, y0 );
		}
		
		private function _onEnterFrame(e:Event):void 
		{
			_capture.bitmapData.draw(_video);
			var detected:Boolean = false;
			try {
				detected = _detector.detectMarkerLite(_raster, 80) && _detector.getConfidence() > 0.5;
			} catch (e:Error) {}
			
			if (detected) {
				_detector.getTransformMatrix(_rmat);
				_de_mat.rawData = Vector.<Number>(
					[  _rmat.m00,   _rmat.m10,   _rmat.m20, 0,
					   _rmat.m01,   _rmat.m11,   _rmat.m21, 0,
					   _rmat.m02,   _rmat.m12,   _rmat.m22, 0,
					   _rmat.m03,   _rmat.m13,   _rmat.m23, 1 ]
				);
				projmat.rawData = Vector.<Number>([0,1,0,0, 1,0,0,0, 0,0,1,0, 0,0,0,1]);
				projmat.append( _de_mat );
				projmat.append( _fr_mat );
				drawObjects();
				_view.visible = true;
			} else {
				_view.visible = false;
			}
		}
		
		//無駄あったから整理した
		private function initCamera( param:FLARParam ):void
		{
			var  size:FLARIntSize = param.getScreenSize();
			var  width:int  = size.w;
			var  height:int = size.h;
			var  tMat:FLARMat = new FLARMat (3, 4);
			var  iMat:FLARMat = new FLARMat (3, 4);
			param.getPerspectiveProjectionMatrix().decompMat(iMat, tMat);
			var icpara:Array = iMat.getArray();
			for (var i:int = 0; i < 4; i++) {
				icpara[1][i] = (height - 1) * (icpara[2][i]) - icpara[1][i];
			}
			var w:Number = icpara[0][0] / icpara[2][2];
			var h:Number = -icpara[1][1] / icpara[2][2];
			_fr_mat.rawData = Vector.<Number>(
				[ w,  0,  0,  0,
				  0,  h,  0,  0,
			      0,  0,  1,  1,
				  0,  0,  0,  0 ]
			);
		}
	}
}

Code Fullscreen

Preview Fullscreen