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
123
124
125
126
127
128
129
|
/*
* Video On Demand Samples
*
* Copyright (C) 2015 Microchip Technology Germany II GmbH & Co. KG
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*
* You may also obtain this software under a propriety license from Microchip.
* Please contact Microchip for further information.
*
*/
#include "Thread.h"
#include <string.h>
#include "Console.h"
CThread::CThread( const char *threadName, bool maxPrio ) : m_hThread( THREAD_STATE_DONE )
{
strncpy( m_threadName, threadName, sizeof( m_threadName ) );
m_maxPrio = maxPrio;
#ifdef THREAD_DEBUG
ConsolePrintf(PRIO_LOW, "===== Thread '%s' has been created =====\n", m_threadName);
#endif
}
CThread::~CThread()
{
Stop();
usleep( 10000 );
while( IsThreadRunning() )
{
ConsolePrintf( PRIO_LOW, "===== Thread '%s' is still running =====\n", m_threadName );
usleep( 1000000 );
}
}
void *CThread::RunInst( void *pInst )
{
CThread *thread = ( CThread * )pInst;
if( NULL == thread )
return 0;
/* set thread priority: */
if( thread->m_maxPrio )
{
int ret;
pthread_t this_thread = pthread_self();
struct sched_param params;
params.sched_priority = sched_get_priority_max( SCHED_FIFO );
ret = pthread_setschedparam( this_thread, SCHED_FIFO, ¶ms );
if( ret != 0 )
{
ConsolePrintf( PRIO_ERROR, "Thread %s: pthread_setschedparam(SCHED_FIFO) failed\n", thread->m_threadName );
}
// Now verify the change in thread priority
int policy = 0;
ret = pthread_getschedparam( this_thread, &policy, ¶ms );
if( ret != 0 )
{
ConsolePrintf( PRIO_ERROR, "Thread %s: pthread_getschedparam() failed\n", thread->m_threadName );
}
if( policy != SCHED_FIFO )
{
ConsolePrintf( PRIO_ERROR, "Thread %s: Scheduling is NOT SCHED_FIFO!\n", thread->m_threadName );
}
else
{
ConsolePrintf( PRIO_LOW, "Thread %s: SCHED_FIFO OK\n", thread->m_threadName );
}
ConsolePrintf( PRIO_LOW, "Thread %s: Thread priority is %d\n", thread->m_threadName, params.sched_priority );
}
while( THREAD_STATE_STOPPING !=
thread->m_hThread )
{ // until thread is marked for termination
#ifdef THREAD_DEBUG
ConsolePrintf(PRIO_LOW, "+++++ Thread '%s' run before Run +++++\n", thread->m_threadName);
#endif
( ( CThread * )pInst )->Run();
#ifdef THREAD_DEBUG
ConsolePrintf(PRIO_LOW, "----- Thread '%s' run after Run -----\n", thread->m_threadName);
#endif
}
( ( CThread * )pInst )->m_hThread = THREAD_STATE_DONE; // mark thread as done
return 0;
}
void CThread::Start()
{
if( THREAD_STATE_DONE != m_hThread )
return;
struct sched_param param;
pthread_attr_t tattr;
pthread_attr_init( &tattr );
pthread_attr_getschedparam( &tattr, ¶m );
pthread_attr_setschedpolicy( &tattr, SCHED_RR );
if( m_maxPrio )
{
param.sched_priority = sched_get_priority_max( SCHED_RR );
pthread_attr_setschedparam( &tattr, ¶m );
// note: this doesn't seem to work, so we're setting prio in RunInst() now
}
pthread_create( &m_hThread, &tattr, CThread::RunInst, ( void * )this );
}
void CThread::Stop()
{
if( m_hThread )
m_hThread = THREAD_STATE_STOPPING;
}
bool CThread::IsThreadRunning()
{
return ( THREAD_STATE_DONE != m_hThread );
}
|
