tilt = vg_clampf(cog[2], -1.0f, 1.0f) * 0.3f;
v4f rz; m4x3f tr;
- q_axis_angle( rz, (v3f){0.0f,0.0f,1.0f}, -cog[0]*0.6f );
+ q_axis_angle( rz, (v3f){0.0f,0.0f,1.0f}, -cog[0]*0.3f );
q_m3x3( rz, tr );
- v3_copy( (v3f){0.0f,dip,tilt}, tr[3] );
+ m3x3_identity( tr );
+ //v3_copy( (v3f){0.0f,dip,tilt}, tr[3] );
+ v3_copy( cog, tr[3] );
- m4x3_mulv( tr, pose->b0, npose.b0 );
+ v3_muladd( pose->b0, tr[3], (v3f){0.85f,1.0f,1.0f}, npose.b0 );
+ //m4x3_mulv( tr, pose->b0, npose.b0 );
m4x3_mulv( tr, pose->b1, npose.b1 );
m4x3_mulv( tr, pose->p, npose.p );
m4x3_mulv( tr, pose->pl, npose.pl );