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 static void
  22 say(char *name, uint8_t bits)
  23 {
  24         printf("%s: ", name);
  25         if (bits & CC_RESET_N)
  26                 printf ("R ");
  27         else
  28                 printf (". ");
  29         if (bits & CC_CLOCK)
  30                 printf ("C ");
  31         else
  32                 printf (". ");
  33         if (bits & CC_DATA)
  34                 printf ("D\n");
  35         else
  36                 printf (".\n");
  37 }
  38
  39 static void
  40 _cccp_write(struct ccdbg *dbg, uint8_t mask, uint8_t value)
  41 {
  42         uint16_t        set;
  43         int             ret;
  44
  45         set = (mask) | (value << 8);
  46         dbg->debug_data = (dbg->debug_data & ~mask) | (value & mask);
  47         ret = ioctl(dbg->fd, CP2101_IOCTL_GPIOSET, &set);
  48         if (ret < 0)
  49                 perror("CP2101_IOCTL_GPIOSET");
  50 }
  51
  52 void
  53 cccp_write(struct ccdbg *dbg, uint8_t mask, uint8_t value)
  54 {
  55         _cccp_write(dbg, mask, value);
  56 //      say("w", dbg->debug_data);
  57 }
  58
  59 uint8_t
  60 cccp_read_all(struct ccdbg *dbg)
  61 {
  62         int ret;
  63         uint8_t get;
  64         ret = ioctl(dbg->fd, CP2101_IOCTL_GPIOGET, &get);
  65         if (ret < 0) {
  66                 perror("CP2101_IOCTL_GPIOGET");
  67                 get = 0;
  68         }
  69         return get;
  70 }
  71
  72 uint8_t
  73 cccp_read(struct ccdbg *dbg, uint8_t mask)
  74 {
  75         uint8_t         pull_up;
  76         uint8_t         get;
  77
  78         /* tri-state the bits of interest */
  79         pull_up = (~dbg->debug_data) & mask;
  80         if (pull_up)
  81                 _cccp_write(dbg, pull_up, pull_up);
  82         get = cccp_read_all(dbg);
  83         say("\t\tr", get);
  84         return get & mask;
  85 }
  86
  87 void
  88 cccp_init(struct ccdbg *dbg)
  89 {
  90         /* set all of the GPIOs to a known state */
  91         cccp_write(dbg, 0xf, 0xf);
  92 }
  93
  94 void
  95 cccp_fini(struct ccdbg *dbg)
  96 {
  97         /* set all of the GPIOs to a known state */
  98         cccp_write(dbg, 0xf, 0xf);
  99         dbg->clock = 1;
 100 }