arch/m68k-amiga/card/cardprogramvoltage.c

   1 /*
   2     Copyright © 1995-2014, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: CardProgramVoltage() function.
   6     Lang: english
   7 */
   8
   9 #include "card_intern.h"
  10
  11 AROS_LH2(LONG, CardProgramVoltage,
  12         AROS_LHA(struct CardHandle*, handle, A1),
  13         AROS_LHA(ULONG, voltage, D0),
  14         struct CardResource*, CardResource, 10, Card)
  15 {
  16     AROS_LIBFUNC_INIT
  17
  18     volatile struct GayleIO *gio = (struct GayleIO*)GAYLE_BASE;
  19     UBYTE v;
  20
  21     CARDDEBUG(bug("CardProgramVoltage(%p,%d)\n", handle, voltage));
  22
  23     if (!ISMINE)
  24         return 0;
  25
  26     if (voltage != GAYLE_CFG_0V && voltage != GAYLE_CFG_5V)
  27         return -1; /* Don't want 12V at this point.. */
  28
  29     Disable();
  30     v = gio->config & ~GAYLE_CFG_VOLTAGE;
  31     v |= voltage;
  32     gio->config = v;
  33     Enable();
  34
  35     return 1;
  36
  37     AROS_LIBFUNC_EXIT
  38 }