; generated by Component: ARM Compiler 5.05 update 2 (build 169) Tool: ArmCC [4d0f38]
; commandline ArmCC [--c99 --list --split_sections --debug -c --asm --interleave -o..\..\..\..\build\demo\mico-fire_f429\obj_rvmdk\lsm9ds1_acc_gyr.o --asm_dir=..\..\..\..\Build\demo\MICO-Fire_F429\list_RVMDK\ --list_dir=..\..\..\..\Build\demo\MICO-Fire_F429\list_RVMDK\ --depend=..\..\..\..\build\demo\mico-fire_f429\obj_rvmdk\lsm9ds1_acc_gyr.d --cpu=Cortex-M4.fp --apcs=interwork -O0 --diag_suppress=9931,1,1293 -I..\..\..\..\Board\fire_F429 -I..\..\..\..\Demos\fire\ov2640 -I..\..\..\..\include -I..\..\..\..\libraries\utilities -I..\..\..\..\libraries\utilities\json_c -I..\..\..\..\MICO\core -I..\..\..\..\MICO\security -I..\..\..\..\MICO\system -I..\..\..\..\MICO\system\command_console -I..\..\..\..\Platform\include -I..\..\..\..\Platform\Cortex-M4 -I..\..\..\..\Platform\Cortex-M4\CMSIS -I..\..\..\..\Platform\MCU\STM32F4xx\peripherals -I..\..\..\..\Platform\MCU\STM32F4xx\peripherals\Libraries\STM32F4xx_StdPeriph_Driver\inc -I..\..\..\..\Platform\MCU\STM32F4xx\peripherals\Libraries -I..\..\..\..\Platform\MCU\STM32F4xx\wlan_bus_driver -I..\..\..\..\Platform\Drivers\spi_flash -I..\..\..\..\Platform\Drivers -I..\..\..\..\libraries\daemons\homekit_server -I..\..\..\..\libraries\daemons\http_server -I..\..\..\..\Platform\Drivers\malloc -I..\..\..\..\Platform\Drivers\SDRAM -I..\..\..\..\Platform\Drivers\ov5640 -IG:\GIT_OSC\STM32_develop\F429-V2\develop\6-WIFI\STM32-WiFi\3.wifi_ov5640\Projects\STM32F429\demo\RVMDK\RTE -IC:\Keil_v5\ARM\PACK\Keil\STM32F4xx_DFP\2.5.0\Drivers\CMSIS\Device\ST\STM32F4xx\Include -IC:\Keil_v5\ARM\CMSIS\Include -IC:\Keil_v5\ARM\PACK\Keil\STM32F4xx_DFP\2.5.0 -D__UVISION_VERSION=515 -DSTM32F429xx -DUSE_STDPERIPH_DRIVER -DDEBUG -DHSE_VALUE=25000000 -DOV5640 --omf_browse=..\..\..\..\build\demo\mico-fire_f429\obj_rvmdk\lsm9ds1_acc_gyr.crf ..\..\..\..\Platform\Drivers\sensor\LSM9DS1\lsm9ds1_acc_gyr.c]
                          THUMB

                          AREA ||i.LSM9DS1_ACC_GET_XYZ||, CODE, READONLY, ALIGN=1

                  LSM9DS1_ACC_GET_XYZ PROC
;;;392    
;;;393    static OSStatus LSM9DS1_ACC_GET_XYZ(int16_t *ACC_X, int16_t *ACC_Y, int16_t *ACC_Z)
000000  e92d41fc          PUSH     {r2-r8,lr}
;;;394    {
000004  4604              MOV      r4,r0
000006  460d              MOV      r5,r1
000008  4616              MOV      r6,r2
;;;395      OSStatus err = kNoErr;
00000a  2700              MOVS     r7,#0
;;;396      uint8_t temp[6] = {0};
00000c  2000              MOVS     r0,#0
00000e  9000              STR      r0,[sp,#0]
000010  9001              STR      r0,[sp,#4]
;;;397      
;;;398      if((err = LSM9DS1_ACC_GYR_IO_Read(&temp[0], OUT_X_L_XL, 6)) != kNoErr){
000012  2206              MOVS     r2,#6
000014  2128              MOVS     r1,#0x28
000016  4668              MOV      r0,sp
000018  f7fffffe          BL       LSM9DS1_ACC_GYR_IO_Read
00001c  0007              MOVS     r7,r0
00001e  d002              BEQ      |L1.38|
;;;399        return err;
000020  4638              MOV      r0,r7
                  |L1.34|
;;;400      }
;;;401      *ACC_X = (int32_t)(((int16_t)temp[1] << 8) | (temp[0]));
;;;402      *ACC_Y = (int32_t)(((int16_t)temp[3] << 8) | (temp[2])); 
;;;403      *ACC_Z = (int32_t)(((int16_t)temp[5] << 8) | (temp[4]));
;;;404      
;;;405      
;;;406      return err;
;;;407    }
000022  e8bd81fc          POP      {r2-r8,pc}
                  |L1.38|
000026  f89d0000          LDRB     r0,[sp,#0]            ;401
00002a  f89d1001          LDRB     r1,[sp,#1]            ;401
00002e  ea402001          ORR      r0,r0,r1,LSL #8       ;401
000032  b200              SXTH     r0,r0                 ;401
000034  8020              STRH     r0,[r4,#0]            ;401
000036  f89d0002          LDRB     r0,[sp,#2]            ;402
00003a  f89d1003          LDRB     r1,[sp,#3]            ;402
00003e  ea402001          ORR      r0,r0,r1,LSL #8       ;402
000042  b200              SXTH     r0,r0                 ;402
000044  8028              STRH     r0,[r5,#0]            ;402
000046  f89d0004          LDRB     r0,[sp,#4]            ;403
00004a  f89d1005          LDRB     r1,[sp,#5]            ;403
00004e  ea402001          ORR      r0,r0,r1,LSL #8       ;403
000052  b200              SXTH     r0,r0                 ;403
000054  8030              STRH     r0,[r6,#0]            ;403
000056  4638              MOV      r0,r7                 ;406
000058  e7e3              B        |L1.34|
;;;408    
                          ENDP


                          AREA ||i.LSM9DS1_ACC_GYR_IO_Init||, CODE, READONLY, ALIGN=2

                          REQUIRE _printf_pre_padding
                          REQUIRE _printf_percent
                          REQUIRE _printf_widthprec
                          REQUIRE _printf_d
                          REQUIRE _printf_s
                          REQUIRE _printf_int_dec
                          REQUIRE _printf_str
                  LSM9DS1_ACC_GYR_IO_Init PROC
;;;254    
;;;255    static OSStatus LSM9DS1_ACC_GYR_IO_Init(void)
000000  b538              PUSH     {r3-r5,lr}
;;;256    {
;;;257      // I2C init
;;;258      MicoI2cFinalize(&lsm9ds1_acc_gyr_i2c_device);   // in case error
000002  481b              LDR      r0,|L2.112|
000004  f7fffffe          BL       MicoI2cFinalize
;;;259      MicoI2cInitialize(&lsm9ds1_acc_gyr_i2c_device);
000008  4819              LDR      r0,|L2.112|
00000a  f7fffffe          BL       MicoI2cInitialize
;;;260      
;;;261      if( false == MicoI2cProbeDevice(&lsm9ds1_acc_gyr_i2c_device, 5) ){
00000e  2105              MOVS     r1,#5
000010  4817              LDR      r0,|L2.112|
000012  f7fffffe          BL       MicoI2cProbeDevice
000016  2800              CMP      r0,#0
000018  d127              BNE      |L2.106|
;;;262        lsm9ds1_acc_gyr_log("LSM9DS1_ACC_GYR_ERROR: no i2c device found!");
00001a  bf00              NOP      
00001c  4815              LDR      r0,|L2.116|
00001e  6800              LDR      r0,[r0,#0]  ; mico_debug_enabled
000020  b900              CBNZ     r0,|L2.36|
000022  e01f              B        |L2.100|
                  |L2.36|
000024  4814              LDR      r0,|L2.120|
000026  f7fffffe          BL       mico_rtos_lock_mutex
00002a  215c              MOVS     r1,#0x5c
00002c  a013              ADR      r0,|L2.124|
00002e  f7fffffe          BL       strrchr
000032  b128              CBZ      r0,|L2.64|
000034  215c              MOVS     r1,#0x5c
000036  a011              ADR      r0,|L2.124|
000038  f7fffffe          BL       strrchr
00003c  1c40              ADDS     r0,r0,#1
00003e  e000              B        |L2.66|
                  |L2.64|
000040  a00e              ADR      r0,|L2.124|
                  |L2.66|
000042  4604              MOV      r4,r0
000044  f7fffffe          BL       mico_get_time
000048  4605              MOV      r5,r0
00004a  f44f7083          MOV      r0,#0x106
00004e  4623              MOV      r3,r4
000050  a21a              ADR      r2,|L2.188|
000052  4629              MOV      r1,r5
000054  9000              STR      r0,[sp,#0]
000056  a01d              ADR      r0,|L2.204|
000058  f7fffffe          BL       __2printf
00005c  4806              LDR      r0,|L2.120|
00005e  f7fffffe          BL       mico_rtos_unlock_mutex
000062  bf00              NOP      
                  |L2.100|
000064  bf00              NOP      
;;;263        return kNotInitializedErr;
000066  4829              LDR      r0,|L2.268|
                  |L2.104|
;;;264      }
;;;265      return kNoErr;
;;;266    }
000068  bd38              POP      {r3-r5,pc}
                  |L2.106|
00006a  2000              MOVS     r0,#0                 ;265
00006c  e7fc              B        |L2.104|
;;;267    
                          ENDP

00006e  0000              DCW      0x0000
                  |L2.112|
                          DCD      lsm9ds1_acc_gyr_i2c_device
                  |L2.116|
                          DCD      mico_debug_enabled
                  |L2.120|
                          DCD      stdio_tx_mutex
                  |L2.124|
00007c  2e2e5c2e          DCB      "..\\..\\..\\..\\Platform\\Drivers\\sensor\\LSM9DS1\\lsm"
000080  2e5c2e2e
000084  5c2e2e5c
000088  506c6174
00008c  666f726d
000090  5c447269
000094  76657273
000098  5c73656e
00009c  736f725c
0000a0  4c534d39
0000a4  4453315c
0000a8  6c736d  
0000ab  39647331          DCB      "9ds1_acc_gyr.c",0
0000af  5f616363
0000b3  5f677972
0000b7  2e6300  
0000ba  00                DCB      0
0000bb  00                DCB      0
                  |L2.188|
0000bc  4c534d39          DCB      "LSM9DS1_ACC_GYR",0
0000c0  4453315f
0000c4  4143435f
0000c8  47595200
                  |L2.204|
0000cc  5b25645d          DCB      "[%d][%s: %s:%4d] LSM9DS1_ACC_GYR_ERROR: no i2c device f"
0000d0  5b25733a
0000d4  2025733a
0000d8  2534645d
0000dc  204c534d
0000e0  39445331
0000e4  5f414343
0000e8  5f475952
0000ec  5f455252
0000f0  4f523a20
0000f4  6e6f2069
0000f8  32632064
0000fc  65766963
000100  652066  
000103  6f756e64          DCB      "ound!\r\n",0
000107  210d0a00
00010b  00                DCB      0
                  |L2.268|
                          DCD      0xffffe5c2

                          AREA ||i.LSM9DS1_ACC_GYR_IO_Read||, CODE, READONLY, ALIGN=2

                  LSM9DS1_ACC_GYR_IO_Read PROC
;;;303    */
;;;304    static OSStatus LSM9DS1_ACC_GYR_IO_Read(uint8_t* pBuffer, uint8_t RegisterAddr, uint16_t NumByteToRead)
000000  b5f0              PUSH     {r4-r7,lr}
;;;305    {
000002  b089              SUB      sp,sp,#0x24
000004  4604              MOV      r4,r0
000006  460d              MOV      r5,r1
000008  4617              MOV      r7,r2
;;;306      mico_i2c_message_t lsm9ds1_acc_gyr_i2c_msg = {NULL, NULL, 0, 0, 0, false};
00000a  2000              MOVS     r0,#0
00000c  9005              STR      r0,[sp,#0x14]
00000e  9006              STR      r0,[sp,#0x18]
000010  9007              STR      r0,[sp,#0x1c]
000012  9008              STR      r0,[sp,#0x20]
;;;307      OSStatus iError = kNoErr;
000014  2600              MOVS     r6,#0
;;;308      uint8_t array[8] = {0};
000016  9003              STR      r0,[sp,#0xc]
000018  9004              STR      r0,[sp,#0x10]
;;;309      array[0] = RegisterAddr;
00001a  f88d500c          STRB     r5,[sp,#0xc]
;;;310      
;;;311      iError = MicoI2cBuildCombinedMessage(&lsm9ds1_acc_gyr_i2c_msg, array, pBuffer, 1, NumByteToRead, 3);
00001e  2003              MOVS     r0,#3
000020  2301              MOVS     r3,#1
000022  4622              MOV      r2,r4
000024  a903              ADD      r1,sp,#0xc
000026  e9cd7000          STRD     r7,r0,[sp,#0]
00002a  a805              ADD      r0,sp,#0x14
00002c  f7fffffe          BL       MicoI2cBuildCombinedMessage
000030  4606              MOV      r6,r0
;;;312      if(kNoErr != iError){
000032  b116              CBZ      r6,|L3.58|
;;;313        return kReadErr; 
000034  4806              LDR      r0,|L3.80|
                  |L3.54|
;;;314      }
;;;315      iError = MicoI2cTransfer(&lsm9ds1_acc_gyr_i2c_device, &lsm9ds1_acc_gyr_i2c_msg, 1);
;;;316      if(kNoErr != iError){
;;;317        return kReadErr;
;;;318      }
;;;319      return kNoErr;
;;;320    }
000036  b009              ADD      sp,sp,#0x24
000038  bdf0              POP      {r4-r7,pc}
                  |L3.58|
00003a  2201              MOVS     r2,#1                 ;315
00003c  a905              ADD      r1,sp,#0x14           ;315
00003e  4805              LDR      r0,|L3.84|
000040  f7fffffe          BL       MicoI2cTransfer
000044  4606              MOV      r6,r0                 ;315
000046  b10e              CBZ      r6,|L3.76|
000048  4801              LDR      r0,|L3.80|
00004a  e7f4              B        |L3.54|
                  |L3.76|
00004c  2000              MOVS     r0,#0                 ;319
00004e  e7f2              B        |L3.54|
;;;321    
                          ENDP

                  |L3.80|
                          DCD      0xffffe5a6
                  |L3.84|
                          DCD      lsm9ds1_acc_gyr_i2c_device

                          AREA ||i.LSM9DS1_ACC_GYR_IO_Write||, CODE, READONLY, ALIGN=2

                  LSM9DS1_ACC_GYR_IO_Write PROC
;;;276    */
;;;277    static OSStatus LSM9DS1_ACC_GYR_IO_Write(uint8_t* pBuffer, uint8_t RegisterAddr, uint16_t NumByteToWrite)
000000  e92d41f0          PUSH     {r4-r8,lr}
;;;278    {
000004  b086              SUB      sp,sp,#0x18
000006  4606              MOV      r6,r0
000008  460f              MOV      r7,r1
00000a  4615              MOV      r5,r2
;;;279      mico_i2c_message_t lsm9ds1_acc_gyr_i2c_msg = {NULL, NULL, 0, 0, 0, false};
00000c  2000              MOVS     r0,#0
00000e  9002              STR      r0,[sp,#8]
000010  9003              STR      r0,[sp,#0xc]
000012  9004              STR      r0,[sp,#0x10]
000014  9005              STR      r0,[sp,#0x14]
;;;280      OSStatus iError = kNoErr;
000016  4680              MOV      r8,r0
;;;281      uint8_t array[8];
;;;282      uint8_t stringpos;
;;;283      array[0] = RegisterAddr;
000018  f88d7000          STRB     r7,[sp,#0]
;;;284      for (stringpos = 0; stringpos < NumByteToWrite; stringpos++) {
00001c  2400              MOVS     r4,#0
00001e  e004              B        |L4.42|
                  |L4.32|
;;;285        array[stringpos + 1] = *(pBuffer + stringpos);
000020  5d31              LDRB     r1,[r6,r4]
000022  1c60              ADDS     r0,r4,#1
000024  f80d1000          STRB     r1,[sp,r0]
000028  b2c4              UXTB     r4,r0                 ;284
                  |L4.42|
00002a  42ac              CMP      r4,r5                 ;284
00002c  dbf8              BLT      |L4.32|
;;;286      }
;;;287      
;;;288      iError = MicoI2cBuildTxMessage(&lsm9ds1_acc_gyr_i2c_msg, array, NumByteToWrite + 1, 3);
00002e  1c68              ADDS     r0,r5,#1
000030  b282              UXTH     r2,r0
000032  2303              MOVS     r3,#3
000034  4669              MOV      r1,sp
000036  a802              ADD      r0,sp,#8
000038  f7fffffe          BL       MicoI2cBuildTxMessage
00003c  4680              MOV      r8,r0
;;;289      iError = MicoI2cTransfer(&lsm9ds1_acc_gyr_i2c_device, &lsm9ds1_acc_gyr_i2c_msg, 1);
00003e  2201              MOVS     r2,#1
000040  a902              ADD      r1,sp,#8
000042  4806              LDR      r0,|L4.92|
000044  f7fffffe          BL       MicoI2cTransfer
000048  4680              MOV      r8,r0
;;;290      if(kNoErr != iError){
00004a  f1b80f00          CMP      r8,#0
00004e  d001              BEQ      |L4.84|
;;;291        iError = kWriteErr;
000050  f8df800c          LDR      r8,|L4.96|
                  |L4.84|
;;;292      }
;;;293      
;;;294      return kNoErr;
000054  2000              MOVS     r0,#0
;;;295    }
000056  b006              ADD      sp,sp,#0x18
000058  e8bd81f0          POP      {r4-r8,pc}
;;;296    
                          ENDP

                  |L4.92|
                          DCD      lsm9ds1_acc_gyr_i2c_device
                  |L4.96|
                          DCD      0xffffe5a5

                          AREA ||i.LSM9DS1_ACC_GYR_Init||, CODE, READONLY, ALIGN=1

                  LSM9DS1_ACC_GYR_Init PROC
;;;373    
;;;374    static OSStatus LSM9DS1_ACC_GYR_Init(void)
000000  b510              PUSH     {r4,lr}
;;;375    {
;;;376      OSStatus err = kNoErr;
000002  2400              MOVS     r4,#0
;;;377      
;;;378      if((err = LSM9DS1_ACC_GYR_IO_Init()) != kNoErr){
000004  f7fffffe          BL       LSM9DS1_ACC_GYR_IO_Init
000008  0004              MOVS     r4,r0
00000a  d001              BEQ      |L5.16|
;;;379        return err;
00000c  4620              MOV      r0,r4
                  |L5.14|
;;;380      }
;;;381      
;;;382      if((err = LSM9DS1_ACC_POWER_ON()) != kNoErr){
;;;383        return err;
;;;384      }
;;;385      
;;;386      if((err = LSM9DS1_GYR_POWER_ON()) != kNoErr){
;;;387        return err;
;;;388      }
;;;389      
;;;390      return err;
;;;391    }
00000e  bd10              POP      {r4,pc}
                  |L5.16|
000010  f7fffffe          BL       LSM9DS1_ACC_POWER_ON
000014  0004              MOVS     r4,r0                 ;382
000016  d001              BEQ      |L5.28|
000018  4620              MOV      r0,r4                 ;383
00001a  e7f8              B        |L5.14|
                  |L5.28|
00001c  f7fffffe          BL       LSM9DS1_GYR_POWER_ON
000020  0004              MOVS     r4,r0                 ;386
000022  d001              BEQ      |L5.40|
000024  4620              MOV      r0,r4                 ;387
000026  e7f2              B        |L5.14|
                  |L5.40|
000028  4620              MOV      r0,r4                 ;390
00002a  e7f0              B        |L5.14|
;;;392    
                          ENDP


                          AREA ||i.LSM9DS1_ACC_POWER_OFF||, CODE, READONLY, ALIGN=1

                  LSM9DS1_ACC_POWER_OFF PROC
;;;360    
;;;361    static OSStatus LSM9DS1_ACC_POWER_OFF(void)
000000  b538              PUSH     {r3-r5,lr}
;;;362    {
;;;363      OSStatus err = kNoErr;
000002  2400              MOVS     r4,#0
;;;364      uint8_t temp = 0;
000004  2000              MOVS     r0,#0
000006  9000              STR      r0,[sp,#0]
;;;365      
;;;366      temp = CTRL_REG1_G_OFF;
000008  2020              MOVS     r0,#0x20
00000a  9000              STR      r0,[sp,#0]
;;;367      if((err = LSM9DS1_ACC_GYR_IO_Write(&temp, CTRL_REG1_G, 1)) != kNoErr){
00000c  2201              MOVS     r2,#1
00000e  2110              MOVS     r1,#0x10
000010  4668              MOV      r0,sp
000012  f7fffffe          BL       LSM9DS1_ACC_GYR_IO_Write
000016  0004              MOVS     r4,r0
000018  d001              BEQ      |L6.30|
;;;368        return err;
00001a  4620              MOV      r0,r4
                  |L6.28|
;;;369      }
;;;370      
;;;371      return err;
;;;372    }
00001c  bd38              POP      {r3-r5,pc}
                  |L6.30|
00001e  4620              MOV      r0,r4                 ;371
000020  e7fc              B        |L6.28|
;;;373    
                          ENDP


                          AREA ||i.LSM9DS1_ACC_POWER_ON||, CODE, READONLY, ALIGN=1

                  LSM9DS1_ACC_POWER_ON PROC
;;;321    
;;;322    static OSStatus LSM9DS1_ACC_POWER_ON(void)
000000  b538              PUSH     {r3-r5,lr}
;;;323    {
;;;324      OSStatus err = kNoErr;
000002  2400              MOVS     r4,#0
;;;325      uint8_t temp = 0;
000004  2000              MOVS     r0,#0
000006  9000              STR      r0,[sp,#0]
;;;326      
;;;327      temp = BW_XL_50;
000008  200c              MOVS     r0,#0xc
00000a  9000              STR      r0,[sp,#0]
;;;328      if((err = LSM9DS1_ACC_GYR_IO_Write(&temp, CTRL_REG6_XL, 1)) != kNoErr){
00000c  2201              MOVS     r2,#1
00000e  2120              MOVS     r1,#0x20
000010  4668              MOV      r0,sp
000012  f7fffffe          BL       LSM9DS1_ACC_GYR_IO_Write
000016  0004              MOVS     r4,r0
000018  d001              BEQ      |L7.30|
;;;329        return err;
00001a  4620              MOV      r0,r4
                  |L7.28|
;;;330      }
;;;331      
;;;332      return err;
;;;333    }
00001c  bd38              POP      {r3-r5,pc}
                  |L7.30|
00001e  4620              MOV      r0,r4                 ;332
000020  e7fc              B        |L7.28|
;;;334    
                          ENDP


                          AREA ||i.LSM9DS1_GYR_GET_XYZ||, CODE, READONLY, ALIGN=1

                  LSM9DS1_GYR_GET_XYZ PROC
;;;408    
;;;409    static OSStatus LSM9DS1_GYR_GET_XYZ(int16_t *GYR_X, int16_t *GYR_Y, int16_t *GYR_Z)
000000  e92d41fc          PUSH     {r2-r8,lr}
;;;410    {
000004  4604              MOV      r4,r0
000006  460d              MOV      r5,r1
000008  4616              MOV      r6,r2
;;;411      OSStatus err = kNoErr;
00000a  2700              MOVS     r7,#0
;;;412      uint8_t temp[6] = {0};
00000c  2000              MOVS     r0,#0
00000e  9000              STR      r0,[sp,#0]
000010  9001              STR      r0,[sp,#4]
;;;413    
;;;414      if((err = LSM9DS1_ACC_GYR_IO_Read(&temp[0], OUT_X_L_G, 6)) != kNoErr){
000012  2206              MOVS     r2,#6
000014  2118              MOVS     r1,#0x18
000016  4668              MOV      r0,sp
000018  f7fffffe          BL       LSM9DS1_ACC_GYR_IO_Read
00001c  0007              MOVS     r7,r0
00001e  d002              BEQ      |L8.38|
;;;415        return err;
000020  4638              MOV      r0,r7
                  |L8.34|
;;;416      }
;;;417      *GYR_X = (int32_t)(((int16_t)temp[1] << 8) | (temp[0]));
;;;418      *GYR_Y = (int32_t)(((int16_t)temp[3] << 8) | (temp[2])); 
;;;419      *GYR_Z = (int32_t)(((int16_t)temp[5] << 8) | (temp[4]));
;;;420      
;;;421      return err;
;;;422    }
000022  e8bd81fc          POP      {r2-r8,pc}
                  |L8.38|
000026  f89d0000          LDRB     r0,[sp,#0]            ;417
00002a  f89d1001          LDRB     r1,[sp,#1]            ;417
00002e  ea402001          ORR      r0,r0,r1,LSL #8       ;417
000032  b200              SXTH     r0,r0                 ;417
000034  8020              STRH     r0,[r4,#0]            ;417
000036  f89d0002          LDRB     r0,[sp,#2]            ;418
00003a  f89d1003          LDRB     r1,[sp,#3]            ;418
00003e  ea402001          ORR      r0,r0,r1,LSL #8       ;418
000042  b200              SXTH     r0,r0                 ;418
000044  8028              STRH     r0,[r5,#0]            ;418
000046  f89d0004          LDRB     r0,[sp,#4]            ;419
00004a  f89d1005          LDRB     r1,[sp,#5]            ;419
00004e  ea402001          ORR      r0,r0,r1,LSL #8       ;419
000052  b200              SXTH     r0,r0                 ;419
000054  8030              STRH     r0,[r6,#0]            ;419
000056  4638              MOV      r0,r7                 ;421
000058  e7e3              B        |L8.34|
;;;423    
                          ENDP


                          AREA ||i.LSM9DS1_GYR_POWER_OFF||, CODE, READONLY, ALIGN=1

                  LSM9DS1_GYR_POWER_OFF PROC
;;;347    
;;;348    static OSStatus LSM9DS1_GYR_POWER_OFF(void)
000000  b538              PUSH     {r3-r5,lr}
;;;349    {
;;;350      OSStatus err = kNoErr;
000002  2400              MOVS     r4,#0
;;;351      uint8_t temp = 0;
000004  2000              MOVS     r0,#0
000006  9000              STR      r0,[sp,#0]
;;;352      
;;;353      temp = LSM9DS1_ACC_ODR_OFF;
000008  9000              STR      r0,[sp,#0]
;;;354      if((err = LSM9DS1_ACC_GYR_IO_Write(&temp, CTRL_REG6_XL, 1)) != kNoErr){
00000a  2201              MOVS     r2,#1
00000c  2120              MOVS     r1,#0x20
00000e  4668              MOV      r0,sp
000010  f7fffffe          BL       LSM9DS1_ACC_GYR_IO_Write
000014  0004              MOVS     r4,r0
000016  d001              BEQ      |L9.28|
;;;355        return err;
000018  4620              MOV      r0,r4
                  |L9.26|
;;;356      }
;;;357      
;;;358      return err;
;;;359    }
00001a  bd38              POP      {r3-r5,pc}
                  |L9.28|
00001c  4620              MOV      r0,r4                 ;358
00001e  e7fc              B        |L9.26|
;;;360    
                          ENDP


                          AREA ||i.LSM9DS1_GYR_POWER_ON||, CODE, READONLY, ALIGN=1

                  LSM9DS1_GYR_POWER_ON PROC
;;;334    
;;;335    static OSStatus LSM9DS1_GYR_POWER_ON(void)
000000  b538              PUSH     {r3-r5,lr}
;;;336    {
;;;337      OSStatus err = kNoErr;
000002  2400              MOVS     r4,#0
;;;338      uint8_t temp = 0;
000004  2000              MOVS     r0,#0
000006  9000              STR      r0,[sp,#0]
;;;339      
;;;340      temp = CTRL_REG1_G_DEF;
000008  2020              MOVS     r0,#0x20
00000a  9000              STR      r0,[sp,#0]
;;;341      if((err = LSM9DS1_ACC_GYR_IO_Write(&temp, CTRL_REG1_G, 1)) != kNoErr){
00000c  2201              MOVS     r2,#1
00000e  2110              MOVS     r1,#0x10
000010  4668              MOV      r0,sp
000012  f7fffffe          BL       LSM9DS1_ACC_GYR_IO_Write
000016  0004              MOVS     r4,r0
000018  d001              BEQ      |L10.30|
;;;342        return err;
00001a  4620              MOV      r0,r4
                  |L10.28|
;;;343      }
;;;344      
;;;345      return err;
;;;346    }
00001c  bd38              POP      {r3-r5,pc}
                  |L10.30|
00001e  4620              MOV      r0,r4                 ;345
000020  e7fc              B        |L10.28|
;;;347    
                          ENDP


                          AREA ||i.lsm9ds1_acc_gyr_sensor_deinit||, CODE, READONLY, ALIGN=2

                  lsm9ds1_acc_gyr_sensor_deinit PROC
;;;438    
;;;439    OSStatus lsm9ds1_acc_gyr_sensor_deinit(void)
000000  b510              PUSH     {r4,lr}
;;;440    {
;;;441      OSStatus err = kNoErr;
000002  2400              MOVS     r4,#0
;;;442      
;;;443      if((err = LSM9DS1_ACC_POWER_OFF()) != kNoErr){
000004  f7fffffe          BL       LSM9DS1_ACC_POWER_OFF
000008  0004              MOVS     r4,r0
00000a  d001              BEQ      |L11.16|
;;;444        return err;
00000c  4620              MOV      r0,r4
                  |L11.14|
;;;445      }
;;;446      
;;;447      if((err = LSM9DS1_GYR_POWER_OFF()) != kNoErr){
;;;448        return err;
;;;449      }
;;;450      
;;;451      return MicoI2cFinalize(&lsm9ds1_acc_gyr_i2c_device);
;;;452    }
00000e  bd10              POP      {r4,pc}
                  |L11.16|
000010  f7fffffe          BL       LSM9DS1_GYR_POWER_OFF
000014  0004              MOVS     r4,r0                 ;447
000016  d001              BEQ      |L11.28|
000018  4620              MOV      r0,r4                 ;448
00001a  e7f8              B        |L11.14|
                  |L11.28|
00001c  4801              LDR      r0,|L11.36|
00001e  f7fffffe          BL       MicoI2cFinalize
000022  e7f4              B        |L11.14|
                          ENDP

                  |L11.36|
                          DCD      lsm9ds1_acc_gyr_i2c_device

                          AREA ||i.lsm9ds1_acc_gyr_sensor_init||, CODE, READONLY, ALIGN=1

                  lsm9ds1_acc_gyr_sensor_init PROC
;;;423    
;;;424    OSStatus lsm9ds1_acc_gyr_sensor_init(void)
000000  b510              PUSH     {r4,lr}
;;;425    {
;;;426      return LSM9DS1_ACC_GYR_Init();
000002  f7fffffe          BL       LSM9DS1_ACC_GYR_Init
;;;427    }
000006  bd10              POP      {r4,pc}
;;;428    
                          ENDP


                          AREA ||i.lsm9ds1_acc_read_data||, CODE, READONLY, ALIGN=1

                  lsm9ds1_acc_read_data PROC
;;;428    
;;;429    OSStatus lsm9ds1_acc_read_data(int16_t *ACC_X, int16_t *ACC_Y, int16_t *ACC_Z)
000000  b570              PUSH     {r4-r6,lr}
;;;430    {
000002  4604              MOV      r4,r0
000004  460d              MOV      r5,r1
000006  4616              MOV      r6,r2
;;;431      return LSM9DS1_ACC_GET_XYZ(ACC_X, ACC_Y, ACC_Z);
000008  4632              MOV      r2,r6
00000a  4629              MOV      r1,r5
00000c  4620              MOV      r0,r4
00000e  f7fffffe          BL       LSM9DS1_ACC_GET_XYZ
;;;432    }
000012  bd70              POP      {r4-r6,pc}
;;;433    
                          ENDP


                          AREA ||i.lsm9ds1_gyr_read_data||, CODE, READONLY, ALIGN=1

                  lsm9ds1_gyr_read_data PROC
;;;433    
;;;434    OSStatus lsm9ds1_gyr_read_data(int16_t *GYR_X, int16_t *GYR_Y, int16_t *GYR_Z)
000000  b570              PUSH     {r4-r6,lr}
;;;435    {
000002  4604              MOV      r4,r0
000004  460d              MOV      r5,r1
000006  4616              MOV      r6,r2
;;;436      return LSM9DS1_GYR_GET_XYZ(GYR_X, GYR_Y, GYR_Z);
000008  4632              MOV      r2,r6
00000a  4629              MOV      r1,r5
00000c  4620              MOV      r0,r4
00000e  f7fffffe          BL       LSM9DS1_GYR_GET_XYZ
;;;437    }
000012  bd70              POP      {r4-r6,pc}
;;;438    
                          ENDP


                          AREA ||.data||, DATA, ALIGN=1

                  lsm9ds1_acc_gyr_i2c_device
000000  0200              DCB      0x02,0x00
000002  006a              DCW      0x006a
000004  0001              DCB      0x00,0x01

;*** Start embedded assembler ***

#line 1 "..\\..\\..\\..\\Platform\\Drivers\\sensor\\LSM9DS1\\lsm9ds1_acc_gyr.c"
	AREA ||.rev16_text||, CODE
	THUMB
	EXPORT |__asm___17_lsm9ds1_acc_gyr_c_43ecca7b____REV16|
#line 114 "..\\..\\..\\..\\Platform\\Cortex-M4\\CMSIS\\core_cmInstr.h"
|__asm___17_lsm9ds1_acc_gyr_c_43ecca7b____REV16| PROC
#line 115

 rev16 r0, r0
 bx lr
	ENDP
	AREA ||.revsh_text||, CODE
	THUMB
	EXPORT |__asm___17_lsm9ds1_acc_gyr_c_43ecca7b____REVSH|
#line 128
|__asm___17_lsm9ds1_acc_gyr_c_43ecca7b____REVSH| PROC
#line 129

 revsh r0, r0
 bx lr
	ENDP

;*** End   embedded assembler ***
