summaryrefslogtreecommitdiffhomepage
path: root/digital/zigbit/bitcloud/stack/Components/HAL/avr/atmega1281/common/src/halClkCtrl.c
blob: e6f968d13a914b7ff657860a78120788ac9cf059 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
/**************************************************************************//**
  \file  halClkCtrl.c

  \brief Implementation of clock control module.

  \author
      Atmel Corporation: http://www.atmel.com \n
      Support email: avr@atmel.com

    Copyright (c) 2008-2011, Atmel Corporation. All rights reserved.
    Licensed under Atmel's Limited License Agreement (BitCloudTM).

  \internal
    History:
      29/05/07 E. Ivanov - Created
      16/04/09 A. Khromykh - Refactored
 ******************************************************************************/
/******************************************************************************
 *   WARNING: CHANGING THIS FILE MAY AFFECT CORE FUNCTIONALITY OF THE STACK.  *
 *   EXPERT USERS SHOULD PROCEED WITH CAUTION.                                *
 ******************************************************************************/

/******************************************************************************
                   Includes section
******************************************************************************/
#include <halClkCtrl.h>
#include <halRfCtrl.h>
#include <atomic.h>
#include <halDbg.h>
#include <halDiagnostic.h>
/******************************************************************************
                   Define(s) section
******************************************************************************/
// defines fuse mask for RC oscillator
#define HAL_RC_OSCILLATOR_CLOCK 0x02
// mask for CKSEL bits
#define HAL_CKSEL_MASK          0x0F

/******************************************************************************
                   Prototypes section
******************************************************************************/
void halStartingCalibrate(void);

/******************************************************************************
                   Global variables section
******************************************************************************/
static volatile ClkSource_t clkClockSource;

/******************************************************************************
                   Implementations section
******************************************************************************/
/**************************************************************************//**
\brief Initialization system clock.
******************************************************************************/
void halInitFreq(void)
{
  uint8_t lowFuseByte;

  // wait for end of eeprom writing
  while (EECR & (1 << EEPE));
  ATOMIC_SECTION_ENTER
  BEGIN_MEASURE
    lowFuseByte = SF_GET_LOW_FUSES();
  END_MEASURE(HALATOM_SETLOWFUSES_TIME_LIMIT)
  ATOMIC_SECTION_LEAVE

  if (HAL_RC_OSCILLATOR_CLOCK == (lowFuseByte & HAL_CKSEL_MASK))
    clkClockSource = INTERNAL_RC;
  else
    clkClockSource = OTHER_SOURCE;

  if (INTERNAL_RC == clkClockSource)
  {
    ATOMIC_SECTION_ENTER
    BEGIN_MEASURE
        ASM (
        "push r21                    \n\t"

        "ldi  r21, 0x80              \n\t" /* CLKPR = 1 << CLKPCE */
        "sts  0x0061, r21            \n\t" /* CLKPR = 1 << CLKPCE */

#if (F_CPU == 4000000ul)
        "ldi  r21, 0x01              \n\t" /* CLKPR = 1 << CLKPS0 (1 cycle) */
        "sts  0x0061, r21            \n\t" /* CLKPR = 1 << CLKPS0 (2 cycle) */
#endif
#if (F_CPU == 8000000ul)
        "ldi  r21, 0x00              \n\t" /* CLKPR = 0 (1 cycle) */
        "sts  0x0061, r21            \n\t" /* CLKPR = 0 (2 cycle) */
#endif

        "pop r21                     \n\t"
    );

    END_MEASURE(HALATOM_INITFREQ_TIME_LIMIT)
    ATOMIC_SECTION_LEAVE
    halStartingCalibrate();
  }
}

/**************************************************************************//**
\brief Return clock source

\return
  clock source.
******************************************************************************/
ClkSource_t halGetClockSource(void)
{
  return clkClockSource;
}

/**************************************************************************//**
\brief System clock.

\return
  system clock in Hz.
******************************************************************************/
uint32_t HAL_ReadFreq(void)
{
  return (uint32_t)F_CPU;
}

// eof halClkCtrl.c