http://vbflash.net

1. Toast 를 화면의 고정적으로 띄우도록 하자.

    Handler m_handler = new Handler() {
        public void handleMessage( Message msg ){
            if( msg.what == 0 ){
                Toast.makeText( m_context, "Init Orientation Mode", Toast.LENGTH_SHORT).show();
            }
            else if( msg.what == 1 ){
                int angle = (int)msg.arg1;
               
                if( m_Msg == null ){                   
                    //m_Msg = Toast.makeText( m_context, "Angle = " + angle, Toast.LENGTH_SHORT);                   
                    m_Msg = Toast.makeText( m_context, (String)msg.obj, Toast.LENGTH_SHORT);
                }
                else{
                    m_Msg.setGravity(Gravity.BOTTOM | Gravity.RIGHT, 0, 0);                   
                    //m_Msg.setText( "Angle = " + angle );             
                    m_Msg.setText( (String)msg.obj );
                    m_Msg.show();
                }
            }   
        }
    };

Toast 의 return 되는 값을 저장해두고 값이 없어지는지 아닌지 확인을 합니다.

그리고 Toast 의 메시지를 setText() 함수를 사용하여 내용을 변경하도록 합니다.

자세한 설명은 소스가 짧기 때문에 안합니다~^^

            // test Toast Message
            String str = "init : " + (int)SensorInitAzimuth + ", Present : " + (int)SensorPresentAzimuth + ", diff : " + diff;
            Message msg = Message.obtain();
            msg.what = 1;
            msg.arg1 = (int)angle[2];//(int)(-presentImgAzimuth);
            msg.obj = (Object)str;
            m_handler.sendMessage(msg);

귀찮은 관계로 글자만 올리도록 합니다. 

이클립스 메뉴,

Window -> Preferences -> General -> Appearance -> Colors and Fonts -> Java -> Java Editor Text Font -> Change

아래 그림과 같이 수정하시면 됩니다. 

Reference URL 

http://www.euclideanspace.com/maths/geometry/rotations/conversions/quaternionToEuler/index.htm

위의 주소를 참조하시면 됩니다만!

코드를 수정할 때 Quaternion 이 normalized 되어 있다면, 위에 방식으로, 아니면 아래 방식으로 사용함.

01. normalized

public vector3f Quat2Angle(float x, float y, float z, float w) {

		double pitch, roll, yaw;

		double test = x * y + z * w;
		if (test > 0.499) { // singularity at north pole
			yaw = 2 * Math.atan2(x, w);
			pitch = Math.PI / 2;
			roll = 0;

			vector3f euler = new vector3f((float) pitch, (float) roll,
					(float) yaw);
			return euler;
		}
		if (test < -0.499) { // singularity at south pole
			yaw = -2 * Math.atan2(x, w);
			pitch = -Math.PI / 2;
			roll = 0;
			vector3f euler = new vector3f((float) pitch, (float) roll,
					(float) yaw);
			return euler;
		}
		double sqx = x * x;
		double sqy = y * y;
		double sqz = z * z;
		yaw = Math.atan2(2 * y * w - 2 * x * z, 1 - 2 * sqy - 2 * sqz);
		pitch = Math.asin(2 * test);
		roll = Math.atan2(2 * x * w - 2 * y * z, 1 - 2 * sqx - 2 * sqz);

		vector3f euler = new vector3f((float) pitch, (float) roll, (float) yaw);
		return euler;

	}

gg

01. non-normalized

	public vector3f Quat2Angle(float x, float y, float z, float w) {

		double pitch, roll, yaw;
		double sqw = w * w;
		double sqx = x * x;
		double sqy = y * y;
		double sqz = z * z;
		double unit = (sqx * sqy) + (sqz * sqw);
		double test = (x * y) + (z * w);

		// singularity at north pole
		if (test > 0.499 * unit) {
			pitch = 0.0;
			roll = 2.0 * Math.atan2(x, w);
			yaw = Math.PI / 2;
			vector3f euler = new vector3f((float) pitch, (float) roll, (float) yaw);
			return euler;
		}

		// singularity at south pole
		if (test < -0.499 * unit) {

			pitch = 0.0;
			roll = -2.0 * Math.atan2(x, w);
			yaw = Math.PI / 2;

			vector3f euler = new vector3f((float) pitch, (float) roll,(float) yaw);
			return euler;
		}

		// attitude = pitch (X Axis of OSG)
		// heading = roll (Y Axis of OSG)
		// bank = yaw (Z Axis of OSG)
		pitch = Math.atan2((2.0 * x * w) - (2.0 * y * z), -sqx + sqy - sqz + sqw);
		roll = Math.atan2((2.0 * y * w) - (2.0 * x * z), sqx - sqy - sqz + sqw);
		yaw = Math.asin(2.0 * test / unit);

		vector3f euler = new vector3f((float) pitch, (float) roll, (float) yaw);
		return euler;
	}*/

코드를 따라서 작성해보고, 위의 URL 에서 계산해서 검증할 수 있다. 

확인을 꼭 해보도록 하자. 

그리고 인터넷 소스는 항상 신뢰하지 말자. (수식을 보고 확인을 하고 넘어가도록 하자. )

다 읽었으면 배너 클릭! (뭐 못보면 할 수 없고...)