git.gag.com Git - fw/altos/blob - lib/cc-bitbang.c

   1 /*
   2  * Copyright © 2009 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 <time.h>
  20 #include <stdio.h>
  21 #include <stdlib.h>
  22 #include "ccdbg-debug.h"
  23 #include "cc-bitbang.h"
  24
  25 #define CP_USB_ASYNC
  26
  27 #ifdef CP_USB_ASYNC
  28 #include "cp-usb-async.h"
  29 #else
  30 #include "cp-usb.h"
  31 #endif
  32
  33 struct cc_bitbang {
  34 #ifdef CP_USB_ASYNC
  35         struct cp_usb_async *cp_async;
  36 #else
  37         struct cp_usb *cp;
  38 #endif
  39 };
  40
  41 static uint32_t cc_clock_us = CC_CLOCK_US;
  42 static uint32_t cc_reset_us = CC_RESET_US;
  43
  44 void
  45 cc_bitbang_set_clock(uint32_t us)
  46 {
  47         cc_clock_us = us;
  48 }
  49
  50 void
  51 cc_bitbang_half_clock(struct cc_bitbang *bb)
  52 {
  53         struct timespec req, rem;
  54         req.tv_sec = (cc_clock_us / 2) / 1000000;
  55         req.tv_nsec = ((cc_clock_us / 2) % 1000000) * 1000;
  56         nanosleep(&req, &rem);
  57 }
  58
  59 void
  60 cc_bitbang_wait_reset(struct cc_bitbang *bb)
  61 {
  62         struct timespec req, rem;
  63
  64         cc_bitbang_sync(bb);
  65         req.tv_sec = (cc_reset_us) / 1000000;
  66         req.tv_nsec = ((cc_reset_us) % 1000000) * 1000;
  67         nanosleep(&req, &rem);
  68 }
  69
  70 struct cc_bitbang *
  71 cc_bitbang_open(void)
  72 {
  73         struct cc_bitbang *bb;
  74
  75         bb = calloc(sizeof (struct cc_bitbang), 1);
  76         if (!bb) {
  77                 perror("calloc");
  78                 return NULL;
  79         }
  80 #ifdef CP_USB_ASYNC
  81         bb->cp_async = cp_usb_async_open();
  82         if (!bb->cp_async) {
  83                 free (bb);
  84                 return NULL;
  85         }
  86 #else
  87         bb->cp = cp_usb_open ();
  88         if (!bb->cp) {
  89                 free (bb);
  90                 return NULL;
  91         }
  92 #endif
  93         return bb;
  94 }
  95
  96 void
  97 cc_bitbang_close(struct cc_bitbang *bb)
  98 {
  99 #ifdef CP_USB_ASYNC
 100         cp_usb_async_close(bb->cp_async);
 101 #else
 102         cp_usb_close(bb->cp);
 103 #endif
 104         free (bb);
 105 }
 106
 107 void
 108 cc_bitbang_debug_mode(struct cc_bitbang *bb)
 109 {
 110         /* force two rising clocks while holding RESET_N low */
 111         ccdbg_debug(CC_DEBUG_COMMAND, "#\n");
 112         ccdbg_debug(CC_DEBUG_COMMAND, "# Debug mode\n");
 113         ccdbg_debug(CC_DEBUG_COMMAND, "#\n");
 114         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
 115         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N,          CC_DATA           );
 116         cc_bitbang_wait_reset(bb);
 117         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 118         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N,          CC_DATA           );
 119         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 120         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N,          CC_DATA|CC_RESET_N);
 121         cc_bitbang_wait_reset(bb);
 122 }
 123
 124 void
 125 cc_bitbang_reset(struct cc_bitbang *bb)
 126 {
 127         ccdbg_debug(CC_DEBUG_COMMAND, "#\n");
 128         ccdbg_debug(CC_DEBUG_COMMAND, "# Reset\n");
 129         ccdbg_debug(CC_DEBUG_COMMAND, "#\n");
 130         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
 131         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 132         cc_bitbang_wait_reset(bb);
 133         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 134         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 135         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA           );
 136         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
 137         cc_bitbang_wait_reset(bb);
 138 }
 139
 140 int
 141 cc_bitbang_write(struct cc_bitbang *bb, uint8_t mask, uint8_t value)
 142 {
 143 #ifdef CP_USB_ASYNC
 144         cp_usb_async_write(bb->cp_async, mask, value);
 145 #else
 146         cp_usb_write(bb->cp, mask, value);
 147 #endif
 148         return 0;
 149 }
 150
 151 void
 152 cc_bitbang_read(struct cc_bitbang *bb, uint8_t *valuep)
 153 {
 154 #ifdef CP_USB_ASYNC
 155         cp_usb_async_read(bb->cp_async, valuep);
 156 #else
 157         *valuep = cp_usb_read(bb->cp);
 158 #endif
 159 }
 160
 161 void
 162 cc_bitbang_sync(struct cc_bitbang *bb)
 163 {
 164 #ifdef CP_USB_ASYNC
 165         cp_usb_async_sync(bb->cp_async);
 166 #endif
 167 }
 168
 169 static char
 170 is_bit(uint8_t get, uint8_t mask, char on, uint8_t bit)
 171 {
 172         if (mask&bit) {
 173                 if (get&bit)
 174                         return on;
 175                 else
 176                         return '.';
 177         } else
 178                 return '-';
 179 }
 180
 181 void
 182 cc_bitbang_print(char *format, uint8_t mask, uint8_t set)
 183 {
 184         ccdbg_debug (CC_DEBUG_BITBANG, format,
 185                      is_bit(set, mask, 'C', CC_CLOCK),
 186                      is_bit(set, mask, 'D', CC_DATA),
 187                      is_bit(set, mask, 'R', CC_RESET_N));
 188 }
 189
 190 void
 191 cc_bitbang_send(struct cc_bitbang *bb, uint8_t mask, uint8_t set)
 192 {
 193         cc_bitbang_write(bb, mask, set);
 194         cc_bitbang_print("%c %c %c\n", mask, set);
 195         cc_bitbang_half_clock(bb);
 196 }
 197
 198 void
 199 cc_bitbang_send_bit(struct cc_bitbang *bb, uint8_t bit)
 200 {
 201         if (bit) bit = CC_DATA;
 202         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|bit|CC_RESET_N);
 203         cc_bitbang_send(bb, CC_CLOCK|CC_DATA|CC_RESET_N,          bit|CC_RESET_N);
 204 }
 205
 206 void
 207 cc_bitbang_send_byte(struct cc_bitbang *bb, uint8_t byte)
 208 {
 209         int bit;
 210         ccdbg_debug(CC_DEBUG_BITBANG, "#\n# Send Byte 0x%02x\n#\n", byte);
 211         for (bit = 7; bit >= 0; bit--) {
 212                 cc_bitbang_send_bit(bb, (byte >> bit) & 1);
 213                 if (bit == 3)
 214                         ccdbg_debug(CC_DEBUG_BITBANG, "\n");
 215         }
 216         cc_bitbang_sync(bb);
 217 }
 218
 219 void
 220 cc_bitbang_send_bytes(struct cc_bitbang *bb, uint8_t *bytes, int nbytes)
 221 {
 222         while (nbytes--)
 223                 cc_bitbang_send_byte(bb, *bytes++);
 224 }
 225
 226 void
 227 cc_bitbang_recv_bit(struct cc_bitbang *bb, int first, uint8_t *bit)
 228 {
 229         uint8_t mask = first ? CC_DATA : 0;
 230
 231         cc_bitbang_send(bb, CC_CLOCK|mask|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
 232         cc_bitbang_read(bb, bit);
 233         cc_bitbang_send(bb, CC_CLOCK|     CC_RESET_N,                  CC_RESET_N);
 234 }
 235
 236 void
 237 cc_bitbang_recv_byte(struct cc_bitbang *bb, int first, uint8_t *bytep)
 238 {
 239         uint8_t byte = 0;
 240         uint8_t bits[8];
 241         int     bit;
 242
 243         ccdbg_debug(CC_DEBUG_BITBANG, "#\n# Recv byte\n#\n");
 244         for (bit = 0; bit < 8; bit++) {
 245                 cc_bitbang_recv_bit(bb, first, &bits[bit]);
 246                 first = 0;
 247         }
 248         cc_bitbang_sync(bb);
 249         for (bit = 0; bit < 8; bit++) {
 250                 byte = byte << 1;
 251                 byte |= (bits[bit] & CC_DATA) ? 1 : 0;
 252                 cc_bitbang_print("#\t%c %c %c\n", CC_DATA, bits[bit]);
 253                 if (bit == 3)
 254                         ccdbg_debug(CC_DEBUG_BITBANG, "\n");
 255         }
 256         ccdbg_debug(CC_DEBUG_BITBANG, "#\n# Recv 0x%02x\n#\n", byte);
 257         *bytep = byte;
 258 }
 259
 260 void
 261 cc_bitbang_recv_bytes(struct cc_bitbang *bb, uint8_t *bytes, int nbytes)
 262 {
 263         int i;
 264         int first = 1;
 265         for (i = 0; i < nbytes; i++) {
 266                 cc_bitbang_recv_byte(bb, first, &bytes[i]);
 267                 first = 0;
 268         }
 269 }