+++ /dev/null
-/*
- * Copyright © 2008 Keith Packard <keithp@keithp.com>
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful, but
- * WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License along
- * with this program; if not, write to the Free Software Foundation, Inc.,
- * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
- */
-
-#include "ccdbg.h"
-#include <time.h>
-#ifdef CP_USB_ASYNC
-#include "cp-usb-async.h"
-#else
-#include "cp-usb.h"
-#endif
-
-void
-ccdbg_half_clock(struct ccdbg *dbg)
-{
- struct timespec req, rem;
- req.tv_sec = (CC_CLOCK_US / 2) / 1000000;
- req.tv_nsec = ((CC_CLOCK_US / 2) % 1000000) * 1000;
- nanosleep(&req, &rem);
-}
-
-struct ccdbg *
-ccdbg_open(void)
-{
- struct ccdbg *dbg;
-
- dbg = calloc(sizeof (struct ccdbg), 1);
- if (!dbg) {
- perror("calloc");
- return NULL;
- }
-#ifdef CP_USB_ASYNC
- dbg->cp_async = cp_usb_async_open();
- if (!dbg->cp_async) {
- free (dbg);
- return NULL;
- }
-#else
- dbg->cp = cp_usb_open ();
- if (!dbg->cp) {
- free (dbg);
- return NULL;
- }
-#endif
- return dbg;
-}
-
-void
-ccdbg_close(struct ccdbg *dbg)
-{
-#ifdef CP_USB_ASYNC
- cp_usb_async_close(dbg->cp_async);
-#else
- cp_usb_close(dbg->cp);
-#endif
- free (dbg);
-}
-
-int
-ccdbg_write(struct ccdbg *dbg, uint8_t mask, uint8_t value)
-{
-#ifdef CP_USB_ASYNC
- cp_usb_async_write(dbg->cp_async, mask, value);
-#else
- cp_usb_write(dbg->cp, mask, value);
-#endif
- return 0;
-}
-
-void
-ccdbg_read(struct ccdbg *dbg, uint8_t *valuep)
-{
-#ifdef CP_USB_ASYNC
- cp_usb_async_read(dbg->cp_async, valuep);
-#else
- *valuep = cp_usb_read(dbg->cp);
-#endif
-}
-
-void
-ccdbg_sync_io(struct ccdbg *dbg)
-{
-#ifdef CP_USB_ASYNC
- cp_usb_async_sync(dbg->cp_async);
-#endif
-}
-
-static char
-is_bit(uint8_t get, uint8_t mask, char on, uint8_t bit)
-{
- if (mask&bit) {
- if (get&bit)
- return on;
- else
- return '.';
- } else
- return '-';
-}
-void
-ccdbg_print(char *format, uint8_t mask, uint8_t set)
-{
- ccdbg_debug (CC_DEBUG_BITBANG, format,
- is_bit(set, mask, 'C', CC_CLOCK),
- is_bit(set, mask, 'D', CC_DATA),
- is_bit(set, mask, 'R', CC_RESET_N));
-}
-
-void
-ccdbg_send(struct ccdbg *dbg, uint8_t mask, uint8_t set)
-{
- ccdbg_write(dbg, mask, set);
- ccdbg_print("%c %c %c\n", mask, set);
- ccdbg_half_clock(dbg);
-}
-
-void
-ccdbg_send_bit(struct ccdbg *dbg, uint8_t bit)
-{
- if (bit) bit = CC_DATA;
- ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, CC_CLOCK|bit|CC_RESET_N);
- ccdbg_send(dbg, CC_CLOCK|CC_DATA|CC_RESET_N, bit|CC_RESET_N);
-}
-
-void
-ccdbg_send_byte(struct ccdbg *dbg, uint8_t byte)
-{
- int bit;
- ccdbg_debug(CC_DEBUG_BITBANG, "#\n# Send Byte 0x%02x\n#\n", byte);
- for (bit = 7; bit >= 0; bit--) {
- ccdbg_send_bit(dbg, (byte >> bit) & 1);
- if (bit == 3)
- ccdbg_debug(CC_DEBUG_BITBANG, "\n");
- }
- ccdbg_sync_io(dbg);
-}
-
-void
-ccdbg_send_bytes(struct ccdbg *dbg, uint8_t *bytes, int nbytes)
-{
- while (nbytes--)
- ccdbg_send_byte(dbg, *bytes++);
-}
-
-void
-ccdbg_recv_bit(struct ccdbg *dbg, int first, uint8_t *bit)
-{
- uint8_t mask = first ? CC_DATA : 0;
-
- ccdbg_send(dbg, CC_CLOCK|mask|CC_RESET_N, CC_CLOCK|CC_DATA|CC_RESET_N);
- ccdbg_read(dbg, bit);
- ccdbg_send(dbg, CC_CLOCK| CC_RESET_N, CC_RESET_N);
-}
-
-void
-ccdbg_recv_byte(struct ccdbg *dbg, int first, uint8_t *bytep)
-{
- uint8_t byte = 0;
- uint8_t bits[8];
- int bit;
-
- ccdbg_debug(CC_DEBUG_BITBANG, "#\n# Recv byte\n#\n");
- for (bit = 0; bit < 8; bit++) {
- ccdbg_recv_bit(dbg, first, &bits[bit]);
- first = 0;
- }
- ccdbg_sync_io(dbg);
- for (bit = 0; bit < 8; bit++) {
- byte = byte << 1;
- byte |= (bits[bit] & CC_DATA) ? 1 : 0;
- ccdbg_print("#\t%c %c %c\n", CC_DATA, bits[bit]);
- if (bit == 3)
- ccdbg_debug(CC_DEBUG_BITBANG, "\n");
- }
- ccdbg_debug(CC_DEBUG_BITBANG, "#\n# Recv 0x%02x\n#\n", byte);
- *bytep = byte;
-}
-
-void
-ccdbg_recv_bytes(struct ccdbg *dbg, uint8_t *bytes, int nbytes)
-{
- int i;
- int first = 1;
- for (i = 0; i < nbytes; i++) {
- ccdbg_recv_byte(dbg, first, &bytes[i]);
- first = 0;
- }
-}
-
-void
-ccdbg_cmd_write(struct ccdbg *dbg, uint8_t cmd, uint8_t *data, int len)
-{
- int i;
- ccdbg_send_byte(dbg, cmd);
- for (i = 0; i < len; i++)
- ccdbg_send_byte(dbg, data[i]);
-}
-
-uint8_t
-ccdbg_cmd_write_read8(struct ccdbg *dbg, uint8_t cmd, uint8_t *data, int len)
-{
- uint8_t byte[1];
- ccdbg_cmd_write(dbg, cmd, data, len);
- ccdbg_recv_bytes(dbg, byte, 1);
- return byte[0];
-}
-
-uint16_t
-ccdbg_cmd_write_read16(struct ccdbg *dbg, uint8_t cmd, uint8_t *data, int len)
-{
- uint8_t byte[2];
- ccdbg_cmd_write(dbg, cmd, data, len);
- ccdbg_recv_bytes(dbg, byte, 2);
- return (byte[0] << 8) | byte[1];
-}