CANopenNode/stack/eCos/ecos_helper.cpp at develop · braincorp/CANopenNode · GitHub

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
//============================================================================
/// \file   ecos_helper.cpp
/// \author Uwe Kindler
/// \date   05.09.2013
/// \brief  Implementation of ecos_helper
//============================================================================

//============================================================================
//                                   INCLUDES
//============================================================================
#include <cyg/kernel/kernel.hxx>


//============================================================================
extern "C" cyg_tick_count convertMsToTicks(cyg_tick_count Milliseconds)
{
	static struct Cyg_Clock::converter ms_converter;
	static volatile cyg_atomic conv_init = 0;
	if (!conv_init)
	{
		struct Cyg_Clock::converter temp_ms_converter;
		Cyg_Clock::real_time_clock->get_other_to_clock_converter(
			1000000, &temp_ms_converter);
		Cyg_Scheduler::lock();
		ms_converter = temp_ms_converter;
		conv_init = 1;
		Cyg_Scheduler::unlock();
	}

	return Cyg_Clock::convert(Milliseconds, &ms_converter);
}


//============================================================================
extern "C" cyg_tick_count convertTicksToMs(cyg_tick_count ClockTicks)
{
	static struct Cyg_Clock::converter ms_converter;
	static volatile cyg_atomic conv_init = 0;
	if (!conv_init)
	{
		struct Cyg_Clock::converter temp_ms_converter;
		Cyg_Clock::real_time_clock->get_clock_to_other_converter(
			1000000, &temp_ms_converter);
		Cyg_Scheduler::lock();
		ms_converter = temp_ms_converter;
		conv_init = 1;
		Cyg_Scheduler::unlock();
	}

	return Cyg_Clock::convert(ClockTicks, &ms_converter);
}


//---------------------------------------------------------------------------
// EOF ecos_helper.cpp