1

/**

     2

 * Yagarto specific code

     3

 **/

     4

     6

#include <app_glue.h>

     7

     8

/* provided by POUS.C */

     9

extern unsigned long long common_ticktime__;

    10

extern unsigned long __tick;

    11

    18

static int debug_locked = 0;

    19

static int _DebugDataAvailable = 0;

    20

static unsigned long __debug_tick;

    21

    22

void LPC_GetTime(IEC_TIME*);

    23

void LPC_SetTimer(unsigned long long next, unsigned long long period);

    24

    25

long AtomicCompareExchange(long* atomicvar,long compared, long exchange)

    26

{

    27

	/* No need for real atomic op on LPC,

    28

	 * no possible preemption between debug and PLC */

    29

	long res = *atomicvar;

    30

	if(res == compared){

    31

		*atomicvar = exchange;

    32

	}

    33

	return res;

    34

}

    35

    36

void PLC_GetTime(IEC_TIME *CURRENT_TIME)

    37

{

    38

	/* Call target GetTime function */

    39

	LPC_GetTime(CURRENT_TIME);

    40

}

    41

    42

void PLC_SetTimer(unsigned long long next, unsigned long long period)

    43

{

    44

	LPC_SetTimer(next, period);

    45

}

    46

    47

int startPLC(int argc,char **argv)

    48

{

    49

	if(__init(argc,argv) == 0){

    52

		PLC_SetTimer(0, common_ticktime__);

    53

		return 0;

    54

	}else{

    55

		return 1;

    56

	}

    57

}

    58

    59

int TryEnterDebugSection(void)

    60

{

    61

    if(!debug_locked && __DEBUG){

    62

        debug_locked = 1;

    63

		return 1;

    64

    }

    65

    return 0;

    66

}

    67

    68

void LeaveDebugSection(void)

    69

{

    70

        debug_locked = 0;

    71

}

    72

    73

int stopPLC(void)

    74

{

    75

    __cleanup();

    76

    return 0;

    77

}

    78

    79

/* from plc_debugger.c */

    80

int WaitDebugData(unsigned long *tick)

    81

{

    82

    /* no blocking call on LPC */

    83

    if(_DebugDataAvailable && !debug_locked){

    84

        /* returns 0 on success */

    85

        *tick = __debug_tick;

    86

        _DebugDataAvailable = 0;

    87

        return 0;

    88

    }

    89

    return 1;

    90

}

    91

    92

/* Called by PLC thread when debug_publish finished

    93

 * This is supposed to unlock debugger thread in WaitDebugData*/

    94

void InitiateDebugTransfer(void)

    95

{

    96

    /* remember tick */

    97

    __debug_tick = __tick;

    98

    _DebugDataAvailable = 1;

    99

}

   100

   101

void suspendDebug(int disable)

   102

{

   103

    /* Prevent PLC to enter debug code */

   104

    __DEBUG = !disable;

   105

    debug_locked = !disable;

   106

}

   107

   108

void resumeDebug(void)

   109

{

   110

    /* Let PLC enter debug code */

   111

    __DEBUG = 1;

   112

    debug_locked = 0;

   113

}

   114

   115

int CheckRetainBuffer(void)

   116

{

   124

}

   125

   126

void Retain(unsigned int offset, unsigned int count, void *p)

   127

{

   131

}

   132

   133

void Remind(unsigned int offset, unsigned int count, void *p)

   134

{

   138

}