git.gag.com Git - fw/altos/blob - ccdbg-io.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 ccdbg_quarter_clock(struct ccdbg *dbg)
  23 {
  24         usleep(CC_CLOCK_US / 4);
  25 }
  26
  27 struct ccdbg *
  28 ccdbg_open(char *file)
  29 {
  30         struct ccdbg *dbg;
  31
  32         dbg = calloc(sizeof (struct ccdbg), 1);
  33         if (!dbg) {
  34                 perror("calloc");
  35                 return NULL;
  36         }
  37         dbg->fd = open(file, 2);
  38         if (dbg->fd < 0) {
  39                 perror(file);
  40                 free(dbg);
  41                 return NULL;
  42         }
  43         cccp_init(dbg);
  44         return dbg;
  45 }
  46
  47 void
  48 ccdbg_close(struct ccdbg *dbg)
  49 {
  50         cccp_fini(dbg);
  51         close (dbg->fd);
  52         free (dbg);
  53 }
  54
  55 void
  56 ccdbg_clock_1_0(struct ccdbg *dbg)
  57 {
  58         ccdbg_quarter_clock(dbg);
  59         assert(dbg->clock == 1);
  60         cccp_write(dbg, CC_CLOCK, 0);
  61         dbg->clock = 0;
  62         ccdbg_quarter_clock(dbg);
  63 }
  64
  65 void
  66 ccdbg_clock_0_1(struct ccdbg *dbg)
  67 {
  68         ccdbg_quarter_clock(dbg);
  69         assert(dbg->clock == 0);
  70         cccp_write(dbg, CC_CLOCK, CC_CLOCK);
  71         dbg->clock = 1;
  72         ccdbg_quarter_clock(dbg);
  73 }
  74
  75 /*
  76  * By convention, every macro function is entered with dbg->clock == 1
  77  */
  78
  79 void
  80 ccdbg_write_bit(struct ccdbg *dbg, uint8_t bit)
  81 {
  82         ccdbg_clock_1_0(dbg);
  83         cccp_write(dbg, CC_DATA, bit ? CC_DATA : 0);
  84         ccdbg_clock_0_1(dbg);
  85 }
  86
  87 void
  88 ccdbg_write_byte(struct ccdbg *dbg, uint8_t byte)
  89 {
  90         int     bit;
  91
  92         for (bit = 7; bit >= 0; bit--)
  93                 ccdbg_write_bit(dbg, (byte >> bit) & 1);
  94 }
  95
  96 uint8_t
  97 ccdbg_read_bit(struct ccdbg *dbg)
  98 {
  99         uint8_t data;
 100
 101         ccdbg_clock_1_0(dbg);
 102         data = cccp_read(dbg, CC_DATA);
 103         ccdbg_clock_0_1(dbg);
 104         return data ? 1 : 0;
 105 }
 106
 107 uint8_t
 108 ccdbg_read_byte(struct ccdbg *dbg)
 109 {
 110         int     bit;
 111         uint8_t byte = 0;
 112
 113         for (bit = 7; bit >= 0; bit--)
 114                 byte |= ccdbg_read_bit(dbg) << bit;
 115         return byte;
 116 }
 117
 118 void
 119 ccdbg_cmd_write(struct ccdbg *dbg, uint8_t cmd, uint8_t *data, int len)
 120 {
 121         int     i;
 122         ccdbg_write_byte(dbg, cmd);
 123         for (i = 0; i < len; i++)
 124                 ccdbg_write_byte(dbg, data[i]);
 125 }
 126
 127 uint8_t
 128 ccdbg_cmd_write_read8(struct ccdbg *dbg, uint8_t cmd, uint8_t *data, int len)
 129 {
 130         ccdbg_cmd_write(dbg, cmd, data, len);
 131         return ccdbg_read_byte(dbg);
 132 }
 133
 134 uint16_t
 135 ccdbg_cmd_write_read16(struct ccdbg *dbg, uint8_t cmd, uint8_t *data, int len)
 136 {
 137         uint8_t byte1, byte0;
 138         ccdbg_cmd_write(dbg, cmd, data, len);
 139         byte1 = ccdbg_read_byte(dbg);
 140         byte0 = ccdbg_read_byte(dbg);
 141         return (byte1 << 8) | byte0;
 142 }
 143