rt-arduino-reader-writer02.ino

Go to the documentation of this file.

#include <krnl.h>
 
//Jens s2021
 
// freertos considerations
 
struct rdWrLockTp {
  k_t *rdSem, *wrSem, *fifoSem;
  int rdCount;
};
 
 
struct rdWrLockTp rdWrLock1;
 
volatile int rdInsideFortest = 0;
 
// RD WR LOCK BY SEMAPHORE
 
int rdWrLockInit(struct rdWrLockTp *lock)
{
  lock->rdSem = k_crt_sem(1, 10);
  lock->wrSem = k_crt_sem(1, 10);
  lock->fifoSem = k_crt_sem(1, 10);
  lock->rdCount = 0;
  return 0; // ok - no real chk
}
 
void rdEnter(struct rdWrLockTp *lock)
{
  k_wait(lock->rdSem, 0);
  lock->rdCount++;
  if (lock->rdCount == 1) {
    k_wait(lock->wrSem, 0); // wait until writer is finished
  }
  else if (ki_semval(lock->wrSem) < 0) { // at least one  writer is waiting
 
  }
  k_signal(lock->rdSem);
}
 
void wrEnter(struct rdWrLockTp *lock)
{
   k_wait(lock->wrSem, 0);
}
 
void wrLeave(struct rdWrLockTp *lock)
{
  k_signal(lock->wrSem);
  k_signal(lock->fifoSem);
}
 
void rdLeave(struct rdWrLockTp *lock)
{
  k_wait(lock->rdSem, 0);
  lock->rdCount--;
  rdInsideFortest--;
  if (lock->rdCount == 0) {
    k_signal(lock->wrSem); // wait until writer is finished
  }
  k_signal(lock->rdSem);
}
 
 
void wr(void)
{
  int i = 0;
  while (1) {
    k_eat_ticks( random(100, 1000));
    wrEnter(&rdWrLock1);
    Serial.println("wr in");
    k_eat_ticks( random(100, 2500));
    // just chekking
    if (0 < rdInsideFortest)
      Serial.println("problemmmmmss");
    Serial.println("wr leaving");
    wrLeave(&rdWrLock1);
 
  }
}
 
volatile int rdNr = 0;
void rd(void)
{
  int n;
  DI();
  n = rdNr;
  rdNr++;
  EI();
  while (1) {
    k_eat_ticks( random(100, 1000));
    rdEnter(&rdWrLock1);
    Serial.print("rd>> "); Serial.println(n);
    k_eat_ticks( random(100, 500));
    Serial.print("rd<<"); Serial.println(n);
    rdLeave(&rdWrLock1);
  }
}
void setup()
{
  Serial.begin(115200);  // for output from task 1
  delay(2000);
  k_init(4, 3, 0);
  k_crt_task(wr, 12, 200);
  k_crt_task(rd, 11, 200);
  k_crt_task(rd, 11, 200);
  k_crt_task(rd, 11, 200);
  rdWrLockInit(&rdWrLock1);
  k_start(1); // start kernel with tick speed 1 milli seconds
  Serial.println("if coming hre then init went wrong");
}
 
void loop() {
  /* loop will never be called */
}