mirror of
https://github.com/kelvinlawson/atomthreads.git
synced 2026-10-17 16:27:27 +02:00
Add Atomthreads RTOS source files.
This commit is contained in:
+271
@@ -0,0 +1,271 @@
|
||||
/*
|
||||
* Copyright (c) 2010, Kelvin Lawson. 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.
|
||||
* 3. No personal names or organizations' names associated with the
|
||||
* Atomthreads project may be used to endorse or promote products
|
||||
* derived from this software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE ATOMTHREADS PROJECT 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 PROJECT 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.
|
||||
*/
|
||||
|
||||
|
||||
#include "atom.h"
|
||||
#include "atomtests.h"
|
||||
#include "atommutex.h"
|
||||
|
||||
|
||||
/* Test OS objects */
|
||||
static ATOM_MUTEX mutex1;
|
||||
static ATOM_TCB tcb1;
|
||||
static uint8_t test1_thread_stack[TEST_THREAD_STACK_SIZE];
|
||||
|
||||
|
||||
/* Global shared data protected by mutex */
|
||||
static volatile int shared_data;
|
||||
|
||||
|
||||
/* Forward declarations */
|
||||
static void test_thread_func (uint32_t data);
|
||||
|
||||
|
||||
/**
|
||||
* \b test_start
|
||||
*
|
||||
* Start mutex test.
|
||||
*
|
||||
* This tests basic usage of a mutex. Whichever thread holds the
|
||||
* mutex can modify the global variable "shared_data".
|
||||
*
|
||||
* The main thread first takes the mutex, then creates a second
|
||||
* thread. The second thread should block on the mutex until the
|
||||
* main thread releases it. The test checks that the global
|
||||
* "shared_data" is not modified by the second thread until the
|
||||
* main thread releases the mutex.
|
||||
*
|
||||
* @retval Number of failures
|
||||
*/
|
||||
uint32_t test_start (void)
|
||||
{
|
||||
int failures;
|
||||
int i;
|
||||
|
||||
/* Default to zero failures */
|
||||
failures = 0;
|
||||
|
||||
/* Create mutex */
|
||||
if (atomMutexCreate (&mutex1) != ATOM_OK)
|
||||
{
|
||||
ATOMLOG (_STR("Error creating mutex\n"));
|
||||
failures++;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Initialise the shared_data to zero */
|
||||
shared_data = 0;
|
||||
|
||||
/* Take the mutex to ensure only this thread can modify shared_data */
|
||||
if (atomMutexGet (&mutex1, 0) != ATOM_OK)
|
||||
{
|
||||
ATOMLOG (_STR("Error taking mutex\n"));
|
||||
failures++;
|
||||
}
|
||||
|
||||
/* Create second thread */
|
||||
else if (atomThreadCreate(&tcb1, TEST_THREAD_PRIO, test_thread_func, 1,
|
||||
&test1_thread_stack[TEST_THREAD_STACK_SIZE - 1]) != ATOM_OK)
|
||||
{
|
||||
/* Fail */
|
||||
ATOMLOG (_STR("Error creating test thread\n"));
|
||||
failures++;
|
||||
}
|
||||
|
||||
/*
|
||||
* The second thread has now been created and should block on
|
||||
* the mutex until we release it. We wait a while and check that
|
||||
* shared_data has not been modified.
|
||||
*/
|
||||
for (i = 0; i < 4; i++)
|
||||
{
|
||||
/*
|
||||
* Sleep for a while to give the second thread a chance to
|
||||
* modify shared_data, thought it shouldn't until we
|
||||
* release the mutex.
|
||||
*/
|
||||
atomTimerDelay (SYSTEM_TICKS_PER_SEC/4);
|
||||
|
||||
/* Check shared data. The second thread always sets it to one. */
|
||||
if (shared_data != 0)
|
||||
{
|
||||
ATOMLOG (_STR("Shared data modified\n"));
|
||||
failures++;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* Check successful so far */
|
||||
if (failures == 0)
|
||||
{
|
||||
/*
|
||||
* Release the mutex, which will allow the second thread to
|
||||
* wake and start modifying shared_data.
|
||||
*/
|
||||
if (atomMutexPut (&mutex1) != ATOM_OK)
|
||||
{
|
||||
ATOMLOG (_STR("Failed release\n"));
|
||||
failures++;
|
||||
}
|
||||
|
||||
/*
|
||||
* Wait a little while then check that shared_data has
|
||||
* been modified.
|
||||
*/
|
||||
atomTimerDelay (SYSTEM_TICKS_PER_SEC/4);
|
||||
if (shared_data != 1)
|
||||
{
|
||||
ATOMLOG (_STR("Expected modify\n"));
|
||||
failures++;
|
||||
}
|
||||
|
||||
/*
|
||||
* Release and take the mutex again a few times to ensure
|
||||
* that the mutex continues to protect shared_data.
|
||||
*/
|
||||
for (i = 0; i < 4; i++)
|
||||
{
|
||||
/*
|
||||
* Take the mutex again, to prevent second thread accessing
|
||||
* shared_data.
|
||||
*/
|
||||
if (atomMutexGet (&mutex1, SYSTEM_TICKS_PER_SEC) != ATOM_OK)
|
||||
{
|
||||
ATOMLOG (_STR("Retake %d\n"), i);
|
||||
failures++;
|
||||
break;
|
||||
}
|
||||
else
|
||||
{
|
||||
/*
|
||||
* Set shared_data to 0 and wait to ensure that the
|
||||
* second thread doesn't modify it while we have the
|
||||
* mutex again.
|
||||
*/
|
||||
shared_data = 0;
|
||||
|
||||
/* Wait a while to give second thread potential to run */
|
||||
atomTimerDelay(SYSTEM_TICKS_PER_SEC/4);
|
||||
|
||||
/*
|
||||
* Check that shared_data has not been modified while we
|
||||
* own the mutex.
|
||||
*/
|
||||
if (shared_data != 0)
|
||||
{
|
||||
/* Thread is still modifying the data */
|
||||
ATOMLOG (_STR("Still modifying\n"));
|
||||
failures++;
|
||||
break;
|
||||
}
|
||||
|
||||
/*
|
||||
* Release the mutex, which will allow the second thread to
|
||||
* wake and start modifying shared_data again.
|
||||
*/
|
||||
if (atomMutexPut (&mutex1) != ATOM_OK)
|
||||
{
|
||||
ATOMLOG (_STR("Failed release\n"));
|
||||
failures++;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* Delete mutex, test finished */
|
||||
if (atomMutexDelete (&mutex1) != ATOM_OK)
|
||||
{
|
||||
ATOMLOG (_STR("Delete failed\n"));
|
||||
failures++;
|
||||
}
|
||||
}
|
||||
|
||||
/* Log final status */
|
||||
if (failures == 0)
|
||||
{
|
||||
ATOMLOG (_STR("Pass\n"));
|
||||
}
|
||||
else
|
||||
{
|
||||
ATOMLOG (_STR("Fail(%d)\n"), failures);
|
||||
}
|
||||
|
||||
/* Quit */
|
||||
return failures;
|
||||
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* \b test_thread_func
|
||||
*
|
||||
* Entry point for test thread.
|
||||
*
|
||||
* @param[in] data Unused (optional thread entry parameter)
|
||||
*
|
||||
* @return None
|
||||
*/
|
||||
static void test_thread_func (uint32_t data)
|
||||
{
|
||||
uint8_t status;
|
||||
|
||||
/* Repeatedly attempt to get the mutex and set shared_data to 1 */
|
||||
while (1)
|
||||
{
|
||||
/* Block on the mutex */
|
||||
if ((status = atomMutexGet (&mutex1, 0)) != ATOM_OK)
|
||||
{
|
||||
/* Error getting mutex, notify the status code */
|
||||
ATOMLOG (_STR("G%d\n"), status);
|
||||
break;
|
||||
}
|
||||
|
||||
/* Got the mutex */
|
||||
else
|
||||
{
|
||||
/* Set shared_data to signify that we think we have the mutex */
|
||||
shared_data = 1;
|
||||
|
||||
/* Release the mutex allowing the main thread to take it again */
|
||||
if ((status = atomMutexPut (&mutex1)) != ATOM_OK)
|
||||
{
|
||||
/* Error putting mutex, notify the status code */
|
||||
ATOMLOG (_STR("P%d\n"), status);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/* Loop forever - we only reach here on error */
|
||||
while (1)
|
||||
{
|
||||
atomTimerDelay (SYSTEM_TICKS_PER_SEC);
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user