Translate

Cara Mengakses Sensor Magnetometer / Compass GY-273 (HMC5883L)

Cara Mengakses Sensor Magnetometer / Compass GY-273 (HMC5883L)

         Pagi hari yang cerah ditemani oleh sejuknya angin dingin, seakan membuat diri ini terbang ke nirwana, kali ini saya akan menjelaskan mengenai bagaimana cara mengakses sensor magnetometer atau compass dengan menggunakan bahasa Bascom AVR, sensor ini adalah sensor yang sangat sering sekali dipakai untuk keperluan membaca rotasi atau arah hadap dari sensor, range output dari sensor ini adalah 0 derajat sampai 360 derajat maka dari itu jika menginginkan pebacaan rotasi penuh sangat dianjurkan untuk menggunakan sensor ini, misal untuk menentukan arah utara, selatan, timur dan barat, atau bisa juga untuk petunjuk arah mata angin dsb. Untuk lebih jelasnya berikut penjelasan lengkapnya.



a. Minimum System





b. Sensor GY-273 / HMC5883L





c. Program Bascom AVR

$regfile = "m16def.dat"
$crystal = 11059200
$baud = 9600
$hwstack = 64
$swstack = 64
$framesize = 64
'-------------------------------------------------------------------------------

Config Lcdpin = Pin , Rs = Portc.6 , E = Portc.7 , Db4 = Portc.2
Config Lcdpin = Pin , Db5 = Portc.3 , Db6 = Portc.4 , Db7 = Portc.5
Config Lcd = 16 * 2

Cls
Cursor Off

Main:

'=====[ Global Vars & Constants ]========
Dim Hmc_x As Integer
Dim Hmc_xl As Byte At Hmc_x + 0 Overlay
Dim Hmc_xh As Byte At Hmc_x + 1 Overlay

Dim Hmc_y As Integer
Dim Hmc_yl As Byte At Hmc_y + 0 Overlay
Dim Hmc_yh As Byte At Hmc_y + 1 Overlay

Dim Hmc_z As Integer
Dim Hmc_zl As Byte At Hmc_z + 0 Overlay
Dim Hmc_zh As Byte At Hmc_z + 1 Overlay
Dim Hmc_status As Byte

Dim X1 As Single
Dim Y1 As Single
Dim Z1 As Single
Dim Angle1 As Single
Dim X2 As Single
Dim Y2 As Single
Dim Z2 As Single
Dim Angle2 As Single
Dim Jumlah As Integer
Dim W As Integer

W = 0
Jumlah = 0


Const Hmc_w = &H3C
Const Hmc_r = &H3D

'-------------------------------------------------------------------------------

'=====[ Misc. config ]==============
Config Scl = Portc.0
Config Sda = Portc.1


Config Twi = 400000
I2cinit
Gosub Hmc_initialize
'-------------------------------------------------------------------------------

'*****[ Start of main loop ]*******
Do

   Gosub Hmc_readdata
   Gosub Hmc_readstatus

   ' convert integer to float
   X1 = Hmc_x
   Y1 = Hmc_y
   Z1 = Hmc_z

   Angle1 = Atn2(y1 , X1)
   Angle1 = Angle1 * 57.29577951
   Angle1 = Angle1 + 180

'jika output sensor salah maka lakukan kalibrasi dengan regresi linier
'catat output sudut sensor dan sesuaikan dengan busur drajat
'catat di ms.Exel lalu tampilkan grafik
'pilih menu linier dan akan terlihat rumusnya
'maka akan tampil seperti rumus (misal) y = 0.971x - 20.62
'lalu masukkan kedalam program

   'Angle1 = Angle1 + 20.62
   'Angle1 = Angle1 / 0.971


If Angle1 > 30 And W = 0 Then
Incr Jumlah
W = 1
Waitms 200
End If

If Angle1 < 30 And W = 1 Then
W = 0
End If


Upperline
Lcd "sudut 1 = " ; Fusing(angle1 , "#.#")
Lowerline
Lcd "count = " ; Jumlah



Waitms 200
Cls

Loop

End
'-------------------------------------------------------------------------------


'=====[ Initialize HMC Compass ]========
Hmc_initialize:
   I2cstart
    I2cwbyte Hmc_w
    I2cwbyte &H00
    I2cwbyte &B0101_1000
    I2cwbyte &H0010_0000
    I2cwbyte &H0000_0000
   I2cstop
Return
'-------------------------------------------------------------------------------

'=====[ Read HMC Compass ]===========
Hmc_readstatus:
' Read HMC Compass status
   I2cstart
    I2cwbyte Hmc_w
    I2cwbyte &H09
   I2cstart
    I2cwbyte Hmc_r
    I2crbyte Hmc_status , Nack
   I2cstop
Return
'-------------------------------------------------------------------------------

'=====[ Read HMC Compass ]=========
Hmc_readdata:
   I2cstart
    I2cwbyte Hmc_w
    I2cwbyte &H03
   I2cstart
    I2cwbyte Hmc_r
    I2crbyte Hmc_xh , Ack
    I2crbyte Hmc_xl , Ack
    I2crbyte Hmc_zh , Ack
    I2crbyte Hmc_zl , Ack
    I2crbyte Hmc_yh , Ack
    I2crbyte Hmc_yl , Nack
   I2cstop
Return
'-------------------------------------------------------------------------------





d. DEMO VIDEO 









1 comment:

  1. mohon diberikan contoh mas Yanuar cara mendapatkan sudut untuk dikalibrasi....

    ReplyDelete