qdn_stm32fxxx.c

/**************************************************************************
 *
 * Copyright (c) 2013, Qromodyn Corporation
 * All rights reserved.

 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * 1. Redistributions of source code must retain the above copyright notice, this
 *    list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright notice,
 *    this list of conditions and the following disclaimer in the documentation
 *    and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR
 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 * The views and conclusions contained in the software and documentation are those
 * of the authors and should not be interpreted as representing official policies,
 * either expressed or implied, of the FreeBSD Project.
 **************************************************************************/

// placeholder for general stm32 functions that work on all 100, 200 and 400 platforms.
#include "qdn_xos.h"
#include "qdn_stm32fxxx.h"


void QDN_NVIC_Init(NVIC_InitTypeDef* NVIC_InitStruct) {
#if defined(FREERTOS)
    assert(NVIC_InitStruct->NVIC_IRQChannelPreemptionPriority >= configLIBRARY_MAX_SYSCALL_INTERRUPT_PRIORITY);
    assert(NVIC_InitStruct->NVIC_IRQChannelPreemptionPriority <= configLIBRARY_LOWEST_INTERRUPT_PRIORITY);
#endif
    
    NVIC_Init(NVIC_InitStruct);

}


#include "stm32f10x.h"

extern uint32_t SystemCoreClock;

void QDN_DWT_Init(void)
{
  if (!(CoreDebug->DEMCR & CoreDebug_DEMCR_TRCENA_Msk))
  {
    CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
    DWT->CYCCNT = 0;
    DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
  }
}

uint32_t QDN_DWT_Get(void)
{
  return DWT->CYCCNT;
}

__inline
uint8_t QDN_DWT_Compare(int32_t tp)
{
  return (((int32_t)QDN_DWT_Get() - tp) < 0);
}

void QDN_DWT_Delay(uint32_t us) // microseconds
{
  int32_t tp = QDN_DWT_Get() + us * (SystemCoreClock/1000000);
  while (QDN_DWT_Compare(tp));
}