HMC5883L HMC5983 pusula devresi proton basic

Proton basic compass code
Proton basic compass code

Bir süredir HMC5883L pusula modülü ile çalışmalar yapıyorum, bunları paylaşmamın doğru olacağını düşündüm.

Öncelikle piyasada FAKE olarak adlandırabileceğimiz modüller mevcut. Bu modüllerin chip üzerinde hmc önünde DB veya DA ibaresi mevcut. Bu db ve da ile üretilen modellerin kalibre ve bir takım işlemlerle çalıştığı söyleniyor ama çalışan sağlam modül varken kimse bu işle uğraşmak istemez.

Paylaştığım kod hem HMC5883 hem de HMC5983 ile çalıştığını da belirteyim. Daha önce aynı modül için CCS C kodu paylaşmıştım. Onu da kullanabilirsiniz. Eğer orjinal HMC5883L  bulamazsanız HMC5983L veya basınç sensörü barındıran HMC5983L+BMP180 kullanabilirsiniz.

Ayrıca manyetik sapma koda ilave edilmeli. Dünyadaki her yerin manyetik sapma değeri farklı oluyor. Ve bu değere her yıl 6 dakika eklemek gerekiyor. Manyetik sapma değerlerini aşağıdaki linkten öğrenebilirsiniz:

http://www.magnetic-declination.com/

Not: Pusula sensörü 45 derece altı eğimde hatalı ölçüm yapar. Bunu dikkate alınız. Yapmış olduğunuz devre kerteriz değerini doğrudan etkiler. Pusula sensörünü ferro manyetik malzemelerden uzak tutunuz. Ölçüm değerinin doğru olup olmadığını analog pusula ve pusula sensörü içeren telefon ile teyit ediniz. Hata payı varsa kerteriz değerine +- değer kadar ekleyiniz veya çıkarınız.

Ben pic18f2550 ile test ettim siz diğer işlemcileri de kullanabilirsiniz.
Proton Kodu: Proton derleyicisine kopyalayıp kaydediniz.

Device = 18F2550
Declare Xtal = 20

Config_Start
FOSC = HS
MCLRE = On
PWRT = On
FCMEN = Off
IESO = Off
BOR = Off
VREGEN = Off
WDT = Off
PBADEN = Off
CCP2MX = Off
STVREN = Off
LVP = Off
XINST = Off
Debug = Off
Cp0 = Off
Cp1 = Off
Cp2 = Off
Cp3 = Off
CPB = Off
CPD = Off
WRT0 = Off
WRT1 = Off
WRT2 = Off
WRT3 = Off
WRTB = Off
WRTC = Off
WRTD = Off
EBTR0 = Off
EBTR1 = Off
EBTR2 = Off
EBTR3 = Off
EBTRB = Off
Config_End

Include "AtnFc.inc"
 
Declare LCD_DTPin PORTB.4
Declare LCD_RSPin PORTB.2
Declare LCD_ENPin PORTB.3
Declare LCD_Interface 4
Declare LCD_Lines 4
Declare LCD_Type 0
Declare LCD_CommandUs = 2000
Declare LCD_DataUs =50 ' YADA 255

'Declare Optimiser_Level = 2
'Declare Dead_Code_Remove = On
'Declare Float_Display_Type = Fast     
Declare    Hserial_Baud  = 9600
Declare    Hserial_RCSTA = %10010000     
Declare    Hserial_TXSTA = 100100     
Declare    Hserial_Clear = On
'Declare    PORTB_Pullups true
     
Symbol SCL = PORTB.1
Symbol SDA = PORTB.0 
 
Symbol X_MSB = $03 'Read Register, Output of X MSB 8-bit value.
Symbol X_LSB = $04 'Read Register, Output of X LSB 8-bit value.
Symbol Z_MSB = $05 'Read Register, Output of Z MSB 8-bit value.
Symbol Z_LSB = $06 'Read Register, Output of Z LSB 8-bit value.
Symbol Y_MSB = $07 'Read Register, Output of Y MSB 8-bit value.
Symbol Y_LSB = $08 'Read Register, Output of Y LSB 8-bit value.
 
Symbol WRITE_ADDRESS = $3C  ' Requests Write operation
Symbol READ_ADDRESS  = $3D  ' Requests Read operation
Symbol MODE = $02           ' Mode setting register
Symbol I2C_VAL = $0
 
Dim X As SWord 'x sensor measured value
Dim Y As SWord 'y sensor measured value
Dim Z As SWord 'z sensor measured value
 
Dim XC As Float
Dim YC As Float

Dim Heading As Float
Dim DeclinationAngle As Float
Dim Pi As Float
Dim Pi2 As Float
     
Pi  = 3.141592654
Pi2 = 6.283185307 ; 2*pi
 
DelayMS 100
 
I2COut SDA,SCL, 0x3c, 0x00, [0x70] '(8-average, 15 Hz default, normal measurement)
I2COut SDA,SCL, 0x3c, 0x01, [0xA0] ' (Gain=5)
I2COut SDA,SCL, 0x3c, 0x02, [0x00] ' Send continuous output command

Cls

Main:
I2CIn SDA, SCL, $3D, $03,[X.HighByte ,X.LowByte,Z.HighByte,Z.LowByte,Y.HighByte,Y.LowByte]
XC = X      ;Convert the numbers to Float
YC = Y      ;Either Result will come garbage

ATan2(YC, XC, Heading)                         ;Calculate the ATaan2
'DeclinationAngle = 0.0457;                     ;DeclinationAngle is different in every place
DeclinationAngle = 5.38;                     ;eskişehir manyetik sapma değeri
Heading = Heading + DeclinationAngle;
   
If Heading < 0 Then Heading = Heading + Pi2    ;Add 2*Pi
If Heading > Pi2 Then Heading = Heading - Pi2  ;Subtract 2*Pi
 
Heading = Heading * 57.295779                  ;Convert radians to degrees

Print At 1,1,"Head : ",Dec2 Heading," N   " 

DelayMS 200
GoTo Main

INC Dosyası: Aşağıdaki satırları txt dosyasına kaydedip daha sonra uzantısını inc yapmalısınız. Dosya adı şu şekilde olmalıdır: AtnFc.inc

'-------------------------------------------------------------------------------------------------------------------------------------
' Name      : Atan2                                                       
' Purpose   : Computes the principal value of arc tangent of Y/X, using the
'           : signs of both the arguments to determine the quadrant of the return value
' Input     : PP_AARG holds the Y input
'           : PP_BARG holds the X input
' Output    : PP_AARG holds the arc tangent of Y/X.         
' Notes     : All values are in Radians
'

' Bring two of the compiler's floating point system variables into the program for the Atan2 macro
'
$ifndef __Atan2__

    Dim PP_AARG As Float System
    Dim PP_BARG As Float System
'----------------------------------------------------------------------------------------------- 
    GoTo _Atan2_Main                              ' Jump over the subroutines
'----------------------------------------------------------------------------------------------- 

$define ATan2(pYin, pXin, pResult) '
    PP_AARG = pYin '
    PP_BARG = pXin '
    _Atan2         '
    pResult = PP_AARG

_Atan2 Macro-
    GoSub __Atan2
Endm

#ifMacro- _Atan2 
__Atan2:         
    Dim fYin As PP_AARG
    Dim fXin As PP_BARG
    Dim bQuadrant As Byte System
    Dim tSign As bQuadrant.7

    tSign = 0
    bQuadrant = 0

    If fYin <= 0.0 Then
        If fXin <= 0.0 Then
            bQuadrant = 3
        Else
            bQuadrant = 4
        EndIf 
    ElseIf fXin < 0.0 Then
        bQuadrant = 2
    Else
        bQuadrant = 1
    EndIf 

    If fYin < 0.0 Then
        tSign = 1
        fYin = Abs fYin
    EndIf
   
    fXin = Abs fXin
 
    If fXin = 0.0 Then
        PP_AARG = 1.570796325
        If tSign = 1 Then
            PP_AARG = -PP_AARG
        EndIf
    Else
        PP_AARG = fYin / fXin
        PP_AARG = ATan(PP_AARG)
        bQuadrant = bQuadrant & %01111111   ' Mask out the Sign bit
        Select bQuadrant
            Case 2
                PP_BARG = PP_AARG
                PP_AARG = 3.14159265 - PP_BARG
            Case 3
                PP_AARG = PP_AARG - 3.14159265
            Case 4
                PP_AARG = -PP_AARG
        EndSelect
    EndIf
    Return
#endIfMacro-


 _Atan2_Main:
$endif




Yorumlar

Yorum Gönderme

Popüler Yayınlar:

chrome ile programsız video nasıl indirilir

grup priz ara kablo yapımı

Ultrasonik fare kuş kovucu devresi

dc motor yönü değiştirme devresi

transistör karşılık programları ve txt dosyası

Brenner8 9 usb programlayıcı arayüz programı usburn ve kullanım kılavuzu