Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

Committer:
sahilmgandhi
Date:
Sat Jun 03 00:22:44 2017 +0000
Revision:
46:b156ef445742
Parent:
18:6a4db94011d3
Final code for internal battlebot competition.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sahilmgandhi 18:6a4db94011d3 1 /* mbed Microcontroller Library
sahilmgandhi 18:6a4db94011d3 2 *******************************************************************************
sahilmgandhi 18:6a4db94011d3 3 * Copyright (c) 2016, STMicroelectronics
sahilmgandhi 18:6a4db94011d3 4 * All rights reserved.
sahilmgandhi 18:6a4db94011d3 5 *
sahilmgandhi 18:6a4db94011d3 6 * Redistribution and use in source and binary forms, with or without
sahilmgandhi 18:6a4db94011d3 7 * modification, are permitted provided that the following conditions are met:
sahilmgandhi 18:6a4db94011d3 8 *
sahilmgandhi 18:6a4db94011d3 9 * 1. Redistributions of source code must retain the above copyright notice,
sahilmgandhi 18:6a4db94011d3 10 * this list of conditions and the following disclaimer.
sahilmgandhi 18:6a4db94011d3 11 * 2. Redistributions in binary form must reproduce the above copyright notice,
sahilmgandhi 18:6a4db94011d3 12 * this list of conditions and the following disclaimer in the documentation
sahilmgandhi 18:6a4db94011d3 13 * and/or other materials provided with the distribution.
sahilmgandhi 18:6a4db94011d3 14 * 3. Neither the name of STMicroelectronics nor the names of its contributors
sahilmgandhi 18:6a4db94011d3 15 * may be used to endorse or promote products derived from this software
sahilmgandhi 18:6a4db94011d3 16 * without specific prior written permission.
sahilmgandhi 18:6a4db94011d3 17 *
sahilmgandhi 18:6a4db94011d3 18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
sahilmgandhi 18:6a4db94011d3 19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
sahilmgandhi 18:6a4db94011d3 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
sahilmgandhi 18:6a4db94011d3 21 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
sahilmgandhi 18:6a4db94011d3 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
sahilmgandhi 18:6a4db94011d3 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
sahilmgandhi 18:6a4db94011d3 24 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
sahilmgandhi 18:6a4db94011d3 25 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
sahilmgandhi 18:6a4db94011d3 26 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
sahilmgandhi 18:6a4db94011d3 27 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
sahilmgandhi 18:6a4db94011d3 28 *******************************************************************************
sahilmgandhi 18:6a4db94011d3 29 */
sahilmgandhi 18:6a4db94011d3 30 #if DEVICE_SLEEP
sahilmgandhi 18:6a4db94011d3 31
sahilmgandhi 18:6a4db94011d3 32 #include "cmsis.h"
sahilmgandhi 18:6a4db94011d3 33 #include "us_ticker_api.h"
sahilmgandhi 18:6a4db94011d3 34 #include "sleep_api.h"
sahilmgandhi 18:6a4db94011d3 35 #include "rtc_api_hal.h"
sahilmgandhi 18:6a4db94011d3 36 #include "hal_tick.h"
sahilmgandhi 18:6a4db94011d3 37
sahilmgandhi 18:6a4db94011d3 38 extern void HAL_SuspendTick(void);
sahilmgandhi 18:6a4db94011d3 39 extern void HAL_ResumeTick(void);
sahilmgandhi 18:6a4db94011d3 40
sahilmgandhi 18:6a4db94011d3 41 void hal_sleep(void)
sahilmgandhi 18:6a4db94011d3 42 {
sahilmgandhi 18:6a4db94011d3 43 // Stop HAL tick to avoid to exit sleep in 1ms
sahilmgandhi 18:6a4db94011d3 44 HAL_SuspendTick();
sahilmgandhi 18:6a4db94011d3 45 // Request to enter SLEEP mode
sahilmgandhi 18:6a4db94011d3 46 HAL_PWR_EnterSLEEPMode(PWR_MAINREGULATOR_ON, PWR_SLEEPENTRY_WFI);
sahilmgandhi 18:6a4db94011d3 47
sahilmgandhi 18:6a4db94011d3 48 // Restart HAL tick
sahilmgandhi 18:6a4db94011d3 49 HAL_ResumeTick();
sahilmgandhi 18:6a4db94011d3 50 }
sahilmgandhi 18:6a4db94011d3 51
sahilmgandhi 18:6a4db94011d3 52 void hal_deepsleep(void)
sahilmgandhi 18:6a4db94011d3 53 {
sahilmgandhi 18:6a4db94011d3 54 // Stop HAL tick
sahilmgandhi 18:6a4db94011d3 55 HAL_SuspendTick();
sahilmgandhi 18:6a4db94011d3 56 uint32_t EnterTimeUS = us_ticker_read();
sahilmgandhi 18:6a4db94011d3 57
sahilmgandhi 18:6a4db94011d3 58 // Request to enter STOP mode with regulator in low power mode
sahilmgandhi 18:6a4db94011d3 59 #if TARGET_STM32L4
sahilmgandhi 18:6a4db94011d3 60 int pwrClockEnabled = __HAL_RCC_PWR_IS_CLK_ENABLED();
sahilmgandhi 18:6a4db94011d3 61 int lowPowerModeEnabled = PWR->CR1 & PWR_CR1_LPR;
sahilmgandhi 18:6a4db94011d3 62
sahilmgandhi 18:6a4db94011d3 63 if (!pwrClockEnabled) {
sahilmgandhi 18:6a4db94011d3 64 __HAL_RCC_PWR_CLK_ENABLE();
sahilmgandhi 18:6a4db94011d3 65 }
sahilmgandhi 18:6a4db94011d3 66 if (lowPowerModeEnabled) {
sahilmgandhi 18:6a4db94011d3 67 HAL_PWREx_DisableLowPowerRunMode();
sahilmgandhi 18:6a4db94011d3 68 }
sahilmgandhi 18:6a4db94011d3 69
sahilmgandhi 18:6a4db94011d3 70 HAL_PWREx_EnterSTOP2Mode(PWR_STOPENTRY_WFI);
sahilmgandhi 18:6a4db94011d3 71
sahilmgandhi 18:6a4db94011d3 72 if (lowPowerModeEnabled) {
sahilmgandhi 18:6a4db94011d3 73 HAL_PWREx_EnableLowPowerRunMode();
sahilmgandhi 18:6a4db94011d3 74 }
sahilmgandhi 18:6a4db94011d3 75 if (!pwrClockEnabled) {
sahilmgandhi 18:6a4db94011d3 76 __HAL_RCC_PWR_CLK_DISABLE();
sahilmgandhi 18:6a4db94011d3 77 }
sahilmgandhi 18:6a4db94011d3 78 #else /* TARGET_STM32L4 */
sahilmgandhi 18:6a4db94011d3 79 HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI);
sahilmgandhi 18:6a4db94011d3 80 #endif /* TARGET_STM32L4 */
sahilmgandhi 18:6a4db94011d3 81
sahilmgandhi 18:6a4db94011d3 82 // Restart HAL tick
sahilmgandhi 18:6a4db94011d3 83 HAL_ResumeTick();
sahilmgandhi 18:6a4db94011d3 84
sahilmgandhi 18:6a4db94011d3 85 // After wake-up from STOP reconfigure the PLL
sahilmgandhi 18:6a4db94011d3 86 SetSysClock();
sahilmgandhi 18:6a4db94011d3 87
sahilmgandhi 18:6a4db94011d3 88 TIM_HandleTypeDef TimMasterHandle;
sahilmgandhi 18:6a4db94011d3 89 TimMasterHandle.Instance = TIM_MST;
sahilmgandhi 18:6a4db94011d3 90 __HAL_TIM_SET_COUNTER(&TimMasterHandle, EnterTimeUS);
sahilmgandhi 18:6a4db94011d3 91
sahilmgandhi 18:6a4db94011d3 92 #if DEVICE_LOWPOWERTIMER
sahilmgandhi 18:6a4db94011d3 93 rtc_synchronize();
sahilmgandhi 18:6a4db94011d3 94 #endif
sahilmgandhi 18:6a4db94011d3 95 }
sahilmgandhi 18:6a4db94011d3 96
sahilmgandhi 18:6a4db94011d3 97 #endif