getquat と setquat

HSP3.5 HGIMG4 では、getquat, setquat によりクォータニオンでのオブジェクト姿勢の取得または設定ができるようになりました。これによって物理演算の結果を他のオブジェクトの姿勢として適用するのが容易になりました。
今回はこの getquat, setquat を含めて物理サイコロもどきを作ってみます。
サンプルコードは以下のようになります。

# include "hgimg4.as"

# module
# deffunc qmul array a1, array a2, array a3, local l, local lre1, local lre2
// a1 と a2 のクォータニオン積を a3 に格納する
	lre1 = a1.3
	lre2 = a2.3
	l.0 = a1.0, a1.1, a1.2
	fvinner l, a2.0, a2.1, a2.2
	a3.3 = lre1 * lre2 - l.0

	l.0 = a1.0
	fvouter l, a2.0, a2.1, a2.2
	a3.0 = l.0 + lre2 * a1.0 + lre1 * a2.0
	a3.1 = l.1 + lre2 * a1.1 + lre1 * a2.1
	a3.2 = l.2 + lre2 * a1.2 + lre1 * a2.2
	return


# deffunc qrot array ap, array aq, array ar, local p, local f, local c
// 座標 ap を クォータニオン aq で回転して ar に格納する
	p.0 = ap.0, ap.1, ap.2, 0.0
	ddim f,4
	qmul aq, p, f
	c.0 = -aq.0, -aq.1, -aq.2, aq.3
	qmul f, c, ar
	return
# global

# const EG_CALC GPDRAW_OPT_OBJUPDATE
# const EG_DRAW2D (GPDRAW_OPT_DRAW2D | GPDRAW_OPT_DRAW2D_LATE)
# const EG_DRAW3D (GPDRAW_OPT_DRAWSCENE | GPDRAW_OPT_DRAWSCENE_LATE)

# const DELTA 0.0001

	randomize

	gpreset
	setcls CLSMODE_NONE

// 回転用障害物
	gpbox id, 2, 0x333333
	setpos id, 7.5, 5, -3.5 + double(rnd(100)) * 0.01
	gppbind id, 0
// アヒルと箱
	gpload id, "res/duck"
	setscale id, 0.8, 0.8, 0.8
	duck_id = id

	gpbox id, 2, 0xcccc00
	setpos id, 6, 9, -2
	gppbind id, 1.0, 0.5
	gppset id, GPPSET_DAMPING, 0.0, 0.0
	gppset id, GPPSET_FRICTION, 0.5, 0.75
	setalpha id, 128
	box_id = id
// 床
	gpfloor id, 40,40, 0x6666cc
	gppbind id, 0, 0.5
	gppset id, GPPSET_FRICTION, 0.5, 0.75

	setangr GPOBJ_LIGHT, -96, 32, 0

	setpos GPOBJ_CAMERA, 2, 21, 12
	gplookat GPOBJ_CAMERA, 0, 3, 0

	sdim faces,256,7
	faces.0 = "none"
	faces.1 = "head"
	faces.6 = "foot"
	faces.2 = "tail"
	faces.5 = "chest"
	faces.3 = "left"
	faces.4 = "right"
	ddim scores,7

// クォータニオン用変数
	ddim q,4
	ddim result,4

	fix = 0
	getreq prets, SYSREQ_TIMER
	pre.0 = -999.0, -999.0, -999.0

	repeat
		getreq ts, SYSREQ_TIMER
		getreq fps, SYSREQ_FPS
		redraw 0
		color 0,0,0x33
		boxf
		
		gpdraw EG_CALC

// 箱の状態をアヒルに反映
		getpos box_id, x,y,z
		setpos duck_id, x,y,z

		getquat box_id, q.0, q.1, q.2, q.3
		setquat duck_id, q.0, q.1, q.2, q.3


// 3つの基底を回転し (0,1,0) と内積を取る
		p.0 = 1.0, 0.0, 0.0
		qrot p, q, result
		scores.5 = result.1
		scores.2 = -result.1

		p.0 = 0.0, 1.0, 0.0
		qrot p, q, result
		scores.1 = result.1
		scores.6 = -result.1

		p.0 = 0.0, 0.0, 1.0
		qrot p, q, result
		scores.4 = result.1
		scores.3 = -result.1
		
		
		gpdraw EG_DRAW2D | EG_DRAW3D

		pos 16,16
		color 224,224,224
		font "",36
		mes strf("%2d [fps]", fps)

		max_score = -2.0
		max_fix = 0
		repeat 6,1
			mes strf("%d:",cnt) + faces.cnt + ": " + scores.cnt

			if scores.cnt > max_score {
				max_score = scores.cnt
				max_fix = cnt
			}
		loop

// 動きチェック
		if fix == 0 {
			diff = powf(x - pre.0, 2.0) + powf(y - pre.1, 2.0) + powf(z - pre.2, 2.0)
			if diff < DELTA {
				// 1.0秒止まったら確定とする
				if ts - prets >= 1000 {
					fix = 1
				}
			} else {
				prets = ts
			}
			// 前回の位置を覚えておく
			pre.0 = x,y,z
		} else {
			color 224,0,0
		}

// 現在の目
		gpcnvaxis x2,y2,z2, x,y,z
		pos x2 - 9, y2 - 72
		mes max_fix
		
		redraw 1
		await 1000/60
	loop

サイコロの目を貼るのが面倒だったので代わりにアヒルの向きでサイコロの目の代わりにしました。

目	アヒルの向き
1	頭上から
2	しっぽ
3	左羽
4	右羽
5	正面
6	足

実行結果1

転がる最中も出目候補を表示

実行結果2

出目が確定したら赤色で表示

なおサンプルコード内の qrot 関数は位置ベクトルをクォータニオン回転する関数なので、オブジェクトの向いている方へ延長するベクトルの計算などの他の目的にも応用して使えます。

注意

このサンプルでは物理サイコロの出目を判定していますが、初期状態やパラメータの都合で1～6までがきれいな乱数で出るわけではありませんのでそれを理解した上でご使用ください。このまま使用する場合はもっと派手に回転にするようにパラメータ設定値を調整して出目が適切にばらけるようにするなど対処するといいと思います。