git.gag.com Git - fw/altos/blob - cccp.c

   1 /*
   2  * Copyright © 2008 Keith Packard <keithp@keithp.com>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but
  10  * WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along
  15  * with this program; if not, write to the Free Software Foundation, Inc.,
  16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  17  */
  18
  19 #include "ccdbg.h"
  20
  21 void
  22 cccp_write(struct ccdbg *dbg, uint8_t mask, uint8_t value)
  23 {
  24         uint16_t        set;
  25         int             ret;
  26
  27         set = (mask) | (value << 8);
  28         dbg->debug_data = (dbg->debug_data & ~mask) | (value & mask);
  29         ret = ioctl(dbg->fd, CP2101_IOCTL_GPIOSET, &set);
  30         if (ret < 0)
  31                 perror("CP2101_IOCTL_GPIOSET");
  32 }
  33
  34 uint8_t
  35 cccp_read(struct ccdbg *dbg, uint8_t mask)
  36 {
  37         uint8_t         pull_up;
  38         int             ret;
  39         uint8_t         get;
  40
  41         /* tri-state the bits of interest */
  42         pull_up = (~dbg->debug_data) & mask;
  43         if (pull_up) {
  44                 cccp_write(dbg, pull_up, pull_up);
  45         }
  46         ret = ioctl(dbg->fd, CP2101_IOCTL_GPIOGET, &get);
  47         if (ret < 0) {
  48                 perror("CP2101_IOCTL_GPIOGET");
  49                 get = 0;
  50         }
  51         return get & mask;
  52 }
  53
  54 void
  55 cccp_init(struct ccdbg *dbg)
  56 {
  57         /* set all of the GPIOs to a known state */
  58         cccp_write(dbg, 0xf, 0xf);
  59         dbg->clock = 1;
  60 }
  61
  62 void
  63 cccp_fini(struct ccdbg *dbg)
  64 {
  65         /* set all of the GPIOs to a known state */
  66         cccp_write(dbg, 0xf, 0xf);
  67         dbg->clock = 1;
  68 }