/*
FILENAME...     devSoftAux.cc
USAGE...        Motor record device level support for Soft channel.

*/

/*
 *      Original Author: Ron Sluiter
 *      Date: 06/15/99
 *
 *      Experimental Physics and Industrial Control System (EPICS)
 *
 *      Copyright 1991, the University of Chicago Board of Governors.
 *
 *      This software was produced under  U.S. Government contract
 *      W-31-109-ENG-38 at Argonne National Laboratory.
 *
 *      Beamline Controls & Data Acquisition Group
 *      Experimental Facilities Division
 *      Advanced Photon Source
 *      Argonne National Laboratory
 *
 * Modification Log:
 * -----------------
 * .01 06-16-03 rls Convert to R3.14.x.
 * .02 12-14-04 rls With EPICS R3.14.7 changes to epicsThread.h, need explicit
 *                  #include <stdlib.h>
 * .03 2006-04-10 pnd Convert to linked lists to remove arbitrary maximum
 */


/*
Notes:
- A Channel Access (CA) oriented file had to be created separate from the
primary devSoft.c file because CA and record access code cannot both reside 
in the same file; each defines (redefines) the DBR's.
*/

#include <stdlib.h>
#include <cadef.h>
#include <errlog.h>
#include <epicsEvent.h>
#include <ellLib.h>
#include <dbLock.h>
#include <callback.h>
#include <epicsThread.h>

#include "motorRecord.h"
#include "motor.h"
#include "devSoft.h"

#define STATIC  static

extern volatile int devSoftdebug;
static inline void Debug(int level, const char *format, ...)
{
#ifdef DEBUG
    if (level < devSoftdebug)
    {
        va_list pVar;
        va_start(pVar, format);
        vprintf(format, pVar);
        va_end(pVar);
    }
#endif
}

STATIC void soft_dinp(struct event_handler_args);
STATIC void soft_rdbl(struct event_handler_args);
STATIC void soft_rinp(struct event_handler_args);
STATIC EPICSTHREADFUNC soft_motor_task(void *);
STATIC epicsThreadId soft_motor_id;
STATIC epicsEventId soft_motor_sem;
STATIC ELLLIST soft_motor_list;

STATIC void soft_dinp(struct event_handler_args args)
{
    soft_dinp_func((struct motorRecord *) args.usr, *((short *) args.dbr));
}


STATIC void soft_rdbl(struct event_handler_args args)
{
    soft_rdbl_func((struct motorRecord *) args.usr, *((double *) args.dbr));
}

STATIC void soft_rinp(struct event_handler_args args)
{
    soft_rinp_func((struct motorRecord *) args.usr, *((long *) args.dbr));
}

long soft_init(int after)
{
    if (!after)
    {
        epicsThreadId dbCaTask_tid;
        unsigned int soft_motor_priority;
        int retry = 0;

        soft_motor_sem = epicsEventCreate(epicsEventEmpty);
        ellInit(&soft_motor_list);

        /* 
         * Fix for DMOV processing before the last DRBV update; i.e., lower
         * the priority of the "soft_motor" task below the priority of the
         * "dbCaLink" task.
         */
        while((dbCaTask_tid = epicsThreadGetId("dbCaLink")) == 0 && retry < 10)
        {
            epicsThreadSleep(0.1);
            retry++;
        }

        if (dbCaTask_tid == 0)
        {
            errMessage(0, "cannot find dbCaLink task.");
            return(ERROR);
        }
        soft_motor_priority = epicsThreadGetPriority(dbCaTask_tid);
        soft_motor_priority -= 1;

        soft_motor_id = epicsThreadCreate((char *) "soft_motor", soft_motor_priority, 
                                          epicsThreadGetStackSize(epicsThreadStackBig),
                                          (EPICSTHREADFUNC) soft_motor_task, NULL);
    }
    else
        epicsEventSignal(soft_motor_sem);       /* Start soft_motor_task(). */
    return(OK);
}


long soft_init_record(void *arg)
{
    struct motorRecord *mr = (struct motorRecord *) arg;
    struct motor_node *list_entry;
    struct soft_private *ptr;
    CALLBACK *cbptr;
    int status = 0;

    list_entry = (struct motor_node *) malloc(sizeof(struct motor_node));
    if (!list_entry)
        return(ERROR);

    list_entry->pmr = mr;
    ellAdd(&soft_motor_list, (ELLNODE*) list_entry);

    /* Allocate space for private field. */
    mr->dpvt = (struct soft_private *) malloc(sizeof(struct soft_private));
    ptr = (struct soft_private *) mr->dpvt;
    ptr->dinp_value = (mr->dmov == 0) ? SOFTMOVE : DONE; /* Must match after initialzation. */
    ptr->initialized = false;

    cbptr = &ptr->callback;
    callbackSetCallback((void (*)(struct callbackPvt *)) soft_motor_callback, cbptr);
    callbackSetPriority(priorityMedium, cbptr);
    callbackSetUser(mr, cbptr);
    return ((long) status);
}


STATIC EPICSTHREADFUNC soft_motor_task(void *parm)
{
    struct motorRecord *mr;
    struct motor_node *node;
    chid dinp, rdbl, rinp;
    epicsEventId wait_forever;

    epicsEventWait(soft_motor_sem);     /* Wait for dbLockInitRecords() to execute. */
    SEVCHK(ca_context_create(ca_enable_preemptive_callback), "soft_motor_task: ca_context_create() error");

    while ((node = (struct motor_node *) ellGet(&soft_motor_list)))
    {
        struct soft_private *ptr;

        mr = node->pmr;
        free(node);
        dbScanLock((dbCommon *)mr);

        ptr = (struct soft_private *) mr->dpvt;
        Debug(5, "devSoftAux::soft_motor_task: motor %s link type=%d\n", mr->name, mr->dinp.type);
        Debug(5, "devSoftAux::soft_motor_task: motor %s constantStr=%s dinp link=%s\n", mr->name, mr->dinp.value.constantStr, mr->dinp.value.pv_link.pvname);
        if (((mr->dinp.type == PV_LINK) || 
             (mr->dinp.type == CA_LINK) ||
             (mr->dinp.type == DB_LINK)) &&
             (mr->dinp.value.pv_link.pvname != NULL)) 
        {
            ptr->default_done_behavior = false;
            Debug(5, "devSoftAux::soft_motor_task: adding dinp link for motor %s link=%s\n", mr->name, mr->dinp.value.pv_link.pvname);
            SEVCHK(ca_search(mr->dinp.value.pv_link.pvname, &dinp),
                   "ca_search() failure");
            SEVCHK(ca_add_event(DBR_SHORT, dinp, soft_dinp, mr, NULL),"ca_add_event() failure");
            SEVCHK(ca_pend_io((float) 5.0), "DINP link failure");
        }
        else
        {
            ptr->default_done_behavior = true;
        }
    
        if ((mr->urip != 0) &&
            ((mr->rdbl.type == PV_LINK) || 
             (mr->rdbl.type == CA_LINK) ||
             (mr->rdbl.type == DB_LINK)) &&
             (mr->rdbl.value.pv_link.pvname != NULL)) 
        {
            Debug(5, "devSoftAux::soft_motor_task: adding rdbl link for motor %s link=%s\n", mr->name, mr->rdbl.value.pv_link.pvname);
            SEVCHK(ca_search(mr->rdbl.value.pv_link.pvname, &rdbl),"ca_search() failure");
            SEVCHK(ca_add_event(DBR_DOUBLE, rdbl, soft_rdbl, mr, NULL),"ca_add_event() failure");
            SEVCHK(ca_pend_io((float) 5.0), "RDBL link failure");
        }

        if (((mr->rinp.type == PV_LINK) || 
             (mr->rinp.type == CA_LINK) ||
             (mr->rinp.type == DB_LINK)) &&
             (mr->rinp.value.pv_link.pvname != NULL))
        {
            Debug(5, "devSoftAux::soft_motor_task: adding rinp link for motor %s link=%s\n", mr->name, mr->rinp.value.pv_link.pvname);
            SEVCHK(ca_search(mr->rinp.value.pv_link.pvname, &rinp),"ca_search() failure");
            SEVCHK(ca_add_event(DBR_LONG, rinp, soft_rinp, mr, NULL),"ca_add_event() failure");
            SEVCHK(ca_pend_io((float) 5.0), "RINP link failure");
        }
        dbScanUnlock((dbCommon *)mr);
    }

    ellFree(&soft_motor_list);
    /* Wait on a (never signalled) event here, rather than suspending the
       thread, so as not to show up in the thread list as "SUSPENDED", which
       is usually a sign of a fault. */
    wait_forever = epicsEventCreate(epicsEventEmpty);
    if (wait_forever)
        epicsEventMustWait(wait_forever);

    return(NULL);
}