/****************************************************************************/
/* Copyright 1992 MBARI                                                     */
/****************************************************************************/
/* Summary  : Moog Thruster Motor Controller Interface Module for VxWorks   */
/* Filename : thruster.c                                                    */
/* Author   : Andrew Pearce                                                 */
/* Project  : New ROV                                                       */
/* Version  : Version 1.0                                                   */
/* Created  : 05/19/92                                                      */
/* Modified : 10/08/92                                                      */
/* Archived :                                                               */
/****************************************************************************/
/* Modification History:                                                    */
/* $Header: autoEnable.c,v 1.2 96/03/11 08:47:52 pean Exp $
 * $Log:        autoEnable.c,v $
 * Revision 1.2  96/03/11  08:47:52  08:47:52  pean (Andrew Pearce)
 * No change
 *
 * Revision 1.1  93/07/01  14:39:06  14:39:06  pean (Andrew Pearce)
 * Initial revision
 *
 * Revision 1.1  92/06/29  10:16:44  10:16:44  pean (Andrew Pearce 408-647-3746)
 * Initial revision
 *
 */
/****************************************************************************/

#include <vxWorks.h>                /* vxWorks system declarations          */
#include <lstLib.h>                 /* vxWorks linked list library          */
#include <strLib.h>                 /* vxWorks string library functions     */
#include <taskLib.h>                /* vxWorks task library functions       */
#include <wdLib.h>                  /* vxWorks watch dog timer functions    */
#include <semLib.h>                 /* vxWorks semaphore functions          */

#include <mbariTypes.h>             /* mbari style guide type declarations  */
#include <ModNum.h>                 /* mbari module numbers for error code  */
#include <usrTime.h>                /* mbari time and date functions        */
#include <datamgr.h>                /* Data Manager declarations            */
#include <dm_errno.h>               /* Data Manager error declarations      */

#include <thrusterDM.h>

    STATUS
setRegenMode( MBool regenMode )
{
    DM_Item Items[6];
    Int32       i;

    dm_create("TIBURON.THRUSTER.PORT_HORIZ.REGEN_LIMIT_MODE",
         1, &Items[0], DM_MBOOL, 1, DM_ENDT);

    dm_create("TIBURON.THRUSTER.STBD_HORIZ.REGEN_LIMIT_MODE",
         1, &Items[1], DM_MBOOL, 1, DM_ENDT);

    dm_create("TIBURON.THRUSTER.PORT_VERT.REGEN_LIMIT_MODE",
         1, &Items[2], DM_MBOOL, 1, DM_ENDT);

    dm_create("TIBURON.THRUSTER.STBD_VERT.REGEN_LIMIT_MODE",
         1, &Items[3], DM_MBOOL, 1, DM_ENDT);

    dm_create("TIBURON.THRUSTER.FWD_LATERAL.REGEN_LIMIT_MODE",
         1, &Items[4], DM_MBOOL, 1, DM_ENDT);

    dm_create("TIBURON.THRUSTER.AFT_LATERAL.REGEN_LIMIT_MODE",
         1, &Items[5], DM_MBOOL, 1, DM_ENDT);

    printf ("Setting regen mode: %s\n", (regenMode ? "True" : "False"));

    for (i = 0; i < 6; i++)
    {
        dm_urgent_open(Items[i], DM_STATIC);
        dm_write(Items[i], (char *) &regenMode, sizeof(regenMode), 0);
        dm_urgent_close(Items[i]);
    }

    return (OK);
}