eCompas FRDM-KL46Z + openGL

Hej!
Jako, że nasza płytka posiada magnetometr MAG3110 postanowiłem to wykorzystać i
powstał taki mały nie skomplikowany pseudo kompas w openGL. Narysowałem
trzy linie imitujące igłę kompasu mające wskazywać kierunki i na formatce wyświetlam sobie litery
N - północ oraz S - południe sygnalizujące położenie magnetometru względem biegunów
ziemskich.

Północ:

Południe:

using System;
using System.Collections.Generic;
using System.ComponentModel;
using System.Data;
using System.Drawing;
using System.Linq;
using System.Text;
using System.Windows.Forms;
using SharpGL;
using System.Globalization;

namespace SharpGLWinformsApplication1
{

    public partial class SharpGLForm : Form
    {

        public SharpGLForm()
        {

            InitializeComponent();
            serialPort1.Open();
        }
        string receive;
        private void serialPort1_DataReceived(object sender, System.IO.Ports.SerialDataReceivedEventArgs e)
        {
            try
            {
                receive = serialPort1.ReadTo("\r\n");
                this.Invoke(new EventHandler(displayText));
            }
            catch
            {
                
            }
        }
       
        private string[] parse = new string[3];
        private void displayText(object sender, EventArgs e)
        {
            parse = receive.Split(',');
            textBox1.Text = receive;

        }



        private void openGLControl_OpenGLDraw(object sender, RenderEventArgs e)
        {
            OpenGL gl = openGLControl.OpenGL;           
            gl.Clear(OpenGL.GL_COLOR_BUFFER_BIT | OpenGL.GL_DEPTH_BUFFER_BIT);            
            gl.LoadIdentity();

            
            if (receive != null)
            {
                gl.Rotate(1.0f, (float)Convert.ToInt32(float.Parse(receive, CultureInfo.InvariantCulture)), 0.0f);

                if ((float)Convert.ToInt32(float.Parse(receive, CultureInfo.InvariantCulture)) >= -5 && (float)Convert.ToInt32(float.Parse(receive, CultureInfo.InvariantCulture)) <= 5)
                {

                    label1.Text = "S";
                }
                else label1.Text = "";


                if ((float)Convert.ToInt32(float.Parse(receive, CultureInfo.InvariantCulture)) <= -175 || (float)Convert.ToInt32(float.Parse(receive, CultureInfo.InvariantCulture)) >= 175)
                {
                    label1.Text = "N";
                }
               

            }
            

            gl.Begin(OpenGL.GL_LINES);
            gl.Color(255.0f, 0.0f, 0.0f);
            gl.Vertex(0.0f, 0.0f, 0.0f);
            gl.Color(0.0f, .0f, 255.0f);
            gl.Vertex(1.0f, 1.0f, 1.0f);

            gl.Color(0.0f, 255.0f, 0.0f);
            gl.Vertex(1.0f, 1.0f, 1.0f);
            gl.Color(0.0f, 1.0f, 0.0f);
            gl.Vertex(0.0f, 1.0f, 0.0f);


            gl.Vertex(0.0f, 1.0f, 0.0f);
            gl.Color(0.0f, 200.0f, 100.0f);
            gl.Vertex(0.0f, 0.0f, 0.0f);                        
            gl.End();

            rotation += (float)numericUpDown1.Value;
        }



 
        private void openGLControl_OpenGLInitialized(object sender, EventArgs e)
        {
            
            OpenGL gl = openGLControl.OpenGL;

            
            gl.ClearColor(0, 0, 0, 0);
        }

 
        private void openGLControl_Resized(object sender, EventArgs e)
        {
            OpenGL gl = openGLControl.OpenGL;            
            gl.MatrixMode(OpenGL.GL_PROJECTION);            
            gl.LoadIdentity();            
            gl.Perspective(40.0f, (double)Width / (double)Height, 0.01, 100.0);
            gl.LookAt(0, 3, 1, 0, 0, 0, 0, 0, 1);            
            gl.MatrixMode(OpenGL.GL_MODELVIEW);
        }

        private float rotation = 0.0f;

        private void SharpGLForm_Load(object sender, EventArgs e)
        {

        }


        private void SharpGLForm_FormClosing(object sender, FormClosingEventArgs e)
        {
            serialPort1.Dispose();
            Application.Exit();
        }
        
    }
}

Obsługa magnetometru:

#include "mbed.h"
#include "MMA8451Q.h"
#include "MAG3110.h"
#include "SLCD.h"
#include "TSISensor.h"
#include 

Tutaj jeszcze filmik pokazujący działanie eKompasu w praktyce:

 Przyjemnej zabawy :)