louis/kiibohd-controller: Bootloader/usb.c annotate

annotate Bootloader/usb.c @ 412:e7a3be42ae1e

Debug code for interconnect cable debugging

author	Jacob Alexander <haata@kiibohd.com>
date	Sat, 20 Feb 2016 13:27:49 -0800
parents	ab4515606277
children

rev	line source
193 b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	1 /* Copyright (c) 2011,2012 Simon Schubert <2@0x2c.org>.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	2 * Modifications by Jacob Alexander 2014 <haata@kiibohd.com>
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	3 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	4 * This program is free software: you can redistribute it and/or modify
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	5 * it under the terms of the GNU General Public License as published by
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	6 * the Free Software Foundation, either version 3 of the License, or
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	7 * (at your option) any later version.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	8 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	9 * This program is distributed in the hope that it will be useful,
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	12 * GNU General Public License for more details.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	13 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	14 * You should have received a copy of the GNU General Public License
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	15 * along with this program. If not, see <http://www.gnu.org/licenses/>.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	16 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	17
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	18 // ----- Compiler Includes -----
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	19
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	20 #include <sys/types.h>
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	21 #include <inttypes.h>
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	22 #include <string.h>
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	23
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	24
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	25 // ----- Local Includes -----
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	26
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	27 #include "usb.h"
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	28 #include "usb-internal.h"
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	29
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	30
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	31
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	32 // ----- Variables -----
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	33
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	34 static uint8_t ep0_buf[2][EP0_BUFSIZE] __attribute__((aligned(4)));
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	35 struct usbd_t usb;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	36
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	37
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	38
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	39 // ----- Functions -----
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	40
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	41 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	42 * Returns: 0 when this is was the last transfer, 1 if there is still
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	43 * more to go.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	44 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	45 /* Defaults to EP0 for now */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	46 static int usb_tx_next(struct usbd_ep_pipe_state_t *s)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	47 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	48
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	49 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	50 * Us being here means the previous transfer just completed
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	51 * successfully. That means the host just toggled its data
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	52 * sync bit, and so do we.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	53 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	54 s->data01 ^= 1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	55
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	56 if (s->transfer_size > 0) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	57 size_t thislen = s->transfer_size;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	58
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	59 if (thislen > s->ep_maxsize)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	60 thislen = s->ep_maxsize;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	61
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	62 void *addr = s->data_buf + s->pos;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	63
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	64 if (s->copy_source) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	65 /* Bounce buffer mode */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	66 addr = s->data_buf;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	67 memcpy(addr, s->copy_source + s->pos, thislen);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	68 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	69 s->pos += thislen;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	70 s->transfer_size -= thislen;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	71
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	72 usb_queue_next(s, addr, thislen);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	73 s->pingpong ^= 1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	74
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	75 return (1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	76 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	77
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	78 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	79 * All data has been shipped. Do we need to send a short
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	80 * packet?
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	81 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	82 if (s->short_transfer) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	83 s->short_transfer = 0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	84 usb_queue_next(s, NULL, 0);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	85 s->pingpong ^= 1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	86 return (1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	87 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	88
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	89 if (s->callback)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	90 s->callback(s->data_buf, s->pos, s->callback_data);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	91
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	92 return (0);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	93 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	94
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	95 static void setup_tx(struct usbd_ep_pipe_state_t s, const void buf, size_t len, size_t reqlen, ep_callback_t cb, void *cb_data)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	96 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	97 s->data_buf = (void *)buf;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	98 s->copy_source = NULL;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	99 s->transfer_size = len;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	100 s->pos = 0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	101 s->callback = cb;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	102 s->callback_data = cb_data;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	103 if (s->transfer_size > reqlen)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	104 s->transfer_size = reqlen;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	105 if (s->transfer_size < reqlen && s->transfer_size % s->ep_maxsize == 0)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	106 s->short_transfer = 1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	107 else
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	108 s->short_transfer = 0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	109 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	110
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	111 static void submit_tx(struct usbd_ep_pipe_state_t *s)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	112 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	113 /* usb_tx_next() flips the data toggle, so invert this here. */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	114 s->data01 ^= 1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	115 usb_tx_next(s);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	116 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	117
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	118 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	119 * send USB data (IN device transaction)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	120 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	121 * So far this function is specialized for EP 0 only.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	122 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	123 * Returns: size to be transfered, or -1 on error.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	124 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	125 int usb_tx(struct usbd_ep_pipe_state_t s, const void buf, size_t len, size_t reqlen, ep_callback_t cb, void *cb_data)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	126 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	127 setup_tx(s, buf, len, reqlen, cb, cb_data);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	128 submit_tx(s);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	129 return (s->transfer_size);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	130 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	131
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	132
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	133 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	134 * Returns: 0 when this is was the last transfer, 1 if there is still
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	135 * more to go.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	136 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	137 /* Defaults to EP0 for now */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	138 /* XXX pass usb_stat to validate pingpong */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	139 static int usb_rx_next(struct usbd_ep_pipe_state_t *s)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	140 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	141 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	142 * Us being here means the previous transfer just completed
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	143 * successfully. That means the host just toggled its data
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	144 * sync bit, and so do we.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	145 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	146 s->data01 ^= 1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	147
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	148 size_t thislen = usb_ep_get_transfer_size(s);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	149
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	150 s->transfer_size -= thislen;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	151 s->pos += thislen;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	152
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	153 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	154 * We're done with this buffer now. Switch the pingpong now
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	155 * before we might have to receive the next piece of data.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	156 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	157 s->pingpong ^= 1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	158
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	159 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	160 * If this is a short transfer, or we received what we
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	161 * expected, we're done.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	162 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	163 if (thislen < s->ep_maxsize \|\| s->transfer_size == 0) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	164 if (s->callback)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	165 s->callback(s->data_buf, s->pos, s->callback_data);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	166 return (0);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	167 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	168
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	169 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	170 * Otherwise we still need to receive more data.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	171 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	172 size_t nextlen = s->transfer_size;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	173
308 ab4515606277 Fix whitespace Rowan Decker <Smasher816@gmail.com> parents: 193 diff changeset	174 if (nextlen > s->ep_maxsize)
ab4515606277 Fix whitespace Rowan Decker <Smasher816@gmail.com> parents: 193 diff changeset	175 nextlen = s->ep_maxsize;
193 b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	176
308 ab4515606277 Fix whitespace Rowan Decker <Smasher816@gmail.com> parents: 193 diff changeset	177 void *addr = s->data_buf + s->pos;
193 b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	178 usb_queue_next(s, addr, nextlen);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	179
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	180 return (1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	181 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	182
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	183 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	184 * Receive USB data (OUT device transaction)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	185 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	186 * Returns: size to be received, or -1 on error.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	187 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	188 int usb_rx(struct usbd_ep_pipe_state_t s, void buf, size_t len, ep_callback_t cb, void *cb_data)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	189 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	190 s->data_buf = buf;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	191 s->transfer_size = len;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	192 s->pos = 0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	193 s->callback = cb;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	194 s->callback_data = cb_data;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	195
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	196 size_t thislen = s->transfer_size;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	197 if (thislen > s->ep_maxsize)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	198 thislen = s->ep_maxsize;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	199
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	200 usb_queue_next(s, s->data_buf, thislen);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	201 return (len);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	202 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	203
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	204 int usb_ep0_tx_cp(const void buf, size_t len, size_t reqlen, ep_callback_t cb, void cb_data)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	205 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	206 struct usbd_ep_pipe_state_t *s = &usb.ep_state[0].tx;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	207 enum usb_ep_pingpong pp = s->pingpong;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	208
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	209 setup_tx(s, ep0_buf[pp], len, reqlen, cb, cb_data);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	210 s->copy_source = buf;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	211 submit_tx(s);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	212 return (s->transfer_size);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	213 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	214
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	215 void *usb_ep0_tx_inplace_prepare(size_t len)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	216 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	217 enum usb_ep_pingpong pp = usb.ep_state[0].tx.pingpong;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	218
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	219 if (len > EP0_BUFSIZE)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	220 return (NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	221
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	222 return (ep0_buf[pp]);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	223 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	224
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	225 int usb_ep0_tx(void buf, size_t len, size_t reqlen, ep_callback_t cb, void cb_data)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	226 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	227 return (usb_tx(&usb.ep_state[0].tx, buf, len, reqlen, cb, cb_data));
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	228 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	229
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	230 int usb_ep0_rx(void buf, size_t len, ep_callback_t cb, void cb_data)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	231 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	232 return (usb_rx(&usb.ep_state[0].rx, buf, len, cb, cb_data));
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	233 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	234
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	235
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	236 const struct usbd_config *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	237 usb_get_config_data(int config)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	238 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	239 if (config <= 0)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	240 config = usb.config;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	241
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	242 if (config != 0)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	243 return (usb.identity->configs[config - 1]);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	244 else
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	245 return (NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	246 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	247
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	248 static int usb_set_config(int config)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	249 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	250 const struct usbd_config *config_data;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	251
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	252 if (usb.config != 0) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	253 config_data = usb_get_config_data(-1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	254 if (config_data != NULL && config_data->init != NULL)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	255 config_data->init(0);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	256 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	257
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	258 if (config != 0) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	259 /* XXX overflow */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	260 config_data = usb_get_config_data(config);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	261 if (config_data != NULL && config_data->init != NULL)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	262 config_data->init(1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	263 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	264 usb.config = config;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	265 return (0);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	266 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	267
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	268 static int usb_set_interface(int iface, int altsetting)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	269 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	270 int iface_count = 0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	271
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	272 for (struct usbd_function_ctx_header *fh = &usb.functions;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	273 fh != NULL;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	274 fh = fh->next, iface_count += fh->function->interface_count) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	275 if (iface - iface_count < fh->function->interface_count) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	276 if (fh->function->configure != NULL)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	277 return (fh->function->configure(iface,
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	278 iface - iface_count,
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	279 altsetting,
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	280 fh));
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	281
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	282 /* Default to a single altsetting */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	283 if (altsetting != 0)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	284 return (-1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	285 else
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	286 return (0);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	287 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	288 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	289
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	290 return (-1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	291 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	292
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	293 static int usb_tx_config_desc(int idx, int reqlen)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	294 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	295 const struct usb_desc_config_t *d = usb.identity->configs[idx]->desc;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	296
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	297 usb_ep0_tx_cp(d, d->wTotalLength, reqlen, NULL, NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	298 return (0);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	299 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	300
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	301 static int usb_tx_string_desc(int idx, int reqlen)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	302 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	303 const struct usb_desc_string_t * const *d;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	304
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	305 for (d = usb.identity->string_descs; idx != 0 && *d != NULL; ++d)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	306 --idx;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	307 switch ((uintptr_t)*d) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	308 case (uintptr_t)NULL:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	309 return (-1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	310 case (uintptr_t)USB_DESC_STRING_SERIALNO:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	311 return (usb_tx_serialno(reqlen));
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	312 default:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	313 usb_ep0_tx_cp(d, (d)->bLength, reqlen, NULL, NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	314 return (0);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	315 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	316 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	317
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	318
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	319 static void usb_handle_control_done(void data, ssize_t len, void cbdata)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	320 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	321 if (usb.state == USBD_STATE_SETTING_ADDRESS) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	322 usb.state = USBD_STATE_ADDRESS;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	323 usb_set_addr(usb.address);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	324 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	325 usb_setup_control();
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	326 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	327
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	328 void usb_handle_control_status_cb(ep_callback_t cb)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	329 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	330 /* empty status transfer */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	331 switch (usb.ctrl_dir) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	332 case USB_CTRL_REQ_IN:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	333 usb.ep_state[0].rx.data01 = USB_DATA01_DATA1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	334 usb_rx(&usb.ep_state[0].rx, NULL, 0, cb, NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	335 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	336
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	337 default:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	338 usb.ep_state[0].tx.data01 = USB_DATA01_DATA1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	339 usb_ep0_tx_cp(NULL, 0, 1 /* short packet */, cb, NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	340 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	341 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	342 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	343
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	344 void usb_handle_control_status(int fail)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	345 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	346 if (fail) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	347 usb_pipe_stall(&usb.ep_state[0].rx);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	348 usb_pipe_stall(&usb.ep_state[0].tx);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	349 } else {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	350 usb_handle_control_status_cb(usb_handle_control_done);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	351 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	352 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	353
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	354
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	355 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	356 * Dispatch non-standard request to registered USB functions.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	357 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	358 static void usb_handle_control_nonstd(struct usb_ctrl_req_t *req)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	359 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	360 /* XXX filter by interface/endpoint? */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	361 for (struct usbd_function_ctx_header *fh = &usb.functions; fh != NULL; fh = fh->next) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	362 /* ->control() returns != 0 if it handled the request */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	363 if (fh->function->control != NULL &&
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	364 fh->function->control(req, fh))
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	365 return;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	366 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	367
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	368 usb_handle_control_status(-1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	369 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	370
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	371
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	372 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	373 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	374 * Great resource: http://wiki.osdev.org/Universal_Serial_Bus
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	375 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	376 * Control Transfers
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	377 * -----------------
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	378 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	379 * A control transfer consists of a SETUP transaction (1), zero or
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	380 * more data transactions (IN or OUT) (2), and a final status
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	381 * transaction (3).
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	382 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	383 * Token sequence (data toggle):
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	384 * 1. SETUP (0)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	385 * (2a. OUT (1) ... (toggling))
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	386 * 3a. IN (1)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	387 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	388 * or
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	389 * 1. SETUP (0)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	390 * 2b. IN (1) ... (toggling)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	391 * 3b. OUT (1)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	392 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	393 * Report errors by STALLing the control EP after (1) or (2), so that
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	394 * (3) will STALL. Seems we need to clear the STALL after that so
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	395 * that the next SETUP can make it through.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	396 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	397 *
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	398 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	399
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	400 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	401 * The following code is not written defensively, but instead only
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	402 * asserts values that are essential for correct execution. It
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	403 * accepts a superset of the protocol defined by the standard. We do
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	404 * this to save space.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	405 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	406
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	407 static void usb_handle_control(void data, ssize_t len, void cbdata)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	408 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	409 struct usb_ctrl_req_t *req = data;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	410 uint16_t zero16 = 0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	411 int fail = 1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	412
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	413 usb.ctrl_dir = req->in;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	414
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	415 if (req->type != USB_CTRL_REQ_STD) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	416 usb_handle_control_nonstd(req);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	417 return;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	418 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	419
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	420 /* Only STD requests here */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	421 switch (req->bRequest) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	422 case USB_CTRL_REQ_GET_STATUS:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	423 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	424 * Because we don't support remote wakeup or
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	425 * self-powered operation, and we are specialized to
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	426 * only EP 0 so far, all GET_STATUS replies are just
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	427 * empty.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	428 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	429 usb_ep0_tx_cp(&zero16, sizeof(zero16), req->wLength, NULL, NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	430 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	431
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	432 case USB_CTRL_REQ_CLEAR_FEATURE:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	433 case USB_CTRL_REQ_SET_FEATURE:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	434 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	435 * Nothing to do. Maybe return STALLs on illegal
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	436 * accesses?
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	437 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	438 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	439
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	440 case USB_CTRL_REQ_SET_ADDRESS:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	441 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	442 * We must keep our previous address until the end of
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	443 * the status stage; therefore we can't set the
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	444 * address right now. Since this is a special case,
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	445 * the EP 0 handler will take care of this later on.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	446 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	447 usb.address = req->wValue & 0x7f;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	448 usb.state = USBD_STATE_SETTING_ADDRESS;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	449 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	450
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	451 case USB_CTRL_REQ_GET_DESCRIPTOR:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	452 switch (req->wValue >> 8) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	453 case USB_DESC_DEV:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	454 usb_ep0_tx_cp(usb.identity->dev_desc, usb.identity->dev_desc->bLength,
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	455 req->wLength, NULL, NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	456 fail = 0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	457 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	458 case USB_DESC_CONFIG:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	459 fail = usb_tx_config_desc(req->wValue & 0xff, req->wLength);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	460 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	461 case USB_DESC_STRING:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	462 fail = usb_tx_string_desc(req->wValue & 0xff, req->wLength);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	463 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	464 default:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	465 fail = -1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	466 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	467 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	468 /* we set fail already, so we can go directly to `err' */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	469 goto err;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	470
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	471 case USB_CTRL_REQ_GET_CONFIGURATION:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	472 usb_ep0_tx_cp(&usb.config, 1, req->wLength, NULL, NULL); /* XXX implicit LE */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	473 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	474
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	475 case USB_CTRL_REQ_SET_CONFIGURATION:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	476 if (usb_set_config(req->wValue) < 0)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	477 goto err;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	478 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	479
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	480 case USB_CTRL_REQ_GET_INTERFACE:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	481 /* We only support iface setting 0 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	482 usb_ep0_tx_cp(&zero16, 1, req->wLength, NULL, NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	483 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	484
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	485 case USB_CTRL_REQ_SET_INTERFACE:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	486 if (usb_set_interface(req->wIndex, req->wValue) < 0)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	487 goto err;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	488 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	489
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	490 default:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	491 goto err;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	492 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	493
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	494 fail = 0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	495
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	496 err:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	497 usb_handle_control_status(fail);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	498 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	499
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	500 void usb_setup_control(void)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	501 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	502 void *buf = ep0_buf[usb.ep_state[0].rx.pingpong];
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	503
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	504 usb.ep_state[0].rx.data01 = USB_DATA01_DATA0;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	505 usb.ep_state[0].tx.data01 = USB_DATA01_DATA1;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	506 usb_rx(&usb.ep_state[0].rx, buf, EP0_BUFSIZE, usb_handle_control, NULL);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	507 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	508
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	509
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	510 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	511 * This is called by the interrupt handler
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	512 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	513 void usb_handle_transaction(struct usb_xfer_info *info)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	514 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	515 enum usb_tok_pid pid = usb_get_xfer_pid(info);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	516 struct usbd_ep_state_t *eps = &usb.ep_state[usb_get_xfer_ep(info)];
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	517 struct usbd_ep_pipe_state_t *s = &eps->pipe[usb_get_xfer_dir(info)];
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	518
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	519 switch (pid) {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	520 case USB_PID_SETUP:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	521 case USB_PID_OUT:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	522 /**
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	523 * If we receive a SETUP transaction, but don't expect
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	524 * it (callback set to somewhere else), stall the EP.
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	525 */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	526 if (pid == USB_PID_SETUP && s->callback != usb_handle_control)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	527 usb_handle_control_status(1);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	528 else
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	529 usb_rx_next(s);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	530 if (pid == USB_PID_SETUP)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	531 usb_enable_xfers();
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	532 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	533 case USB_PID_IN:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	534 usb_tx_next(s);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	535 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	536 default:
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	537 break;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	538 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	539 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	540
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	541 struct usbd_ep_pipe_state_t usb_init_ep(struct usbd_function_ctx_header ctx, int ep, enum usb_ep_dir dir, size_t size)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	542 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	543 struct usbd_ep_pipe_state_t *s;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	544
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	545 if (dir == USB_EP_RX)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	546 s = &usb.ep_state[ctx->ep_rx_offset + ep].rx;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	547 else
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	548 s = &usb.ep_state[ctx->ep_tx_offset + ep].tx;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	549
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	550 memset(s, 0, sizeof(*s));
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	551 s->ep_maxsize = size;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	552 s->ep_num = ep;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	553 s->ep_dir = dir;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	554 usb_pipe_enable(s);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	555 return (s);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	556 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	557
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	558 void usb_restart(void)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	559 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	560 const struct usbd_device *identity = usb.identity;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	561 /* XXX reset existing functions? */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	562 memset(&usb, 0, sizeof(usb));
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	563 usb.functions.function = &usb.control_function;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	564 usb.identity = identity;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	565 usb_init_ep(&usb.functions, 0, USB_EP_RX, EP0_BUFSIZE);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	566 usb_init_ep(&usb.functions, 0, USB_EP_TX, EP0_BUFSIZE);
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	567 usb_setup_control();
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	568 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	569
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	570 void usb_attach_function(const struct usbd_function function, struct usbd_function_ctx_header ctx)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	571 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	572 /* XXX right now this requires a sequential initialization */
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	573 struct usbd_function_ctx_header *prev = &usb.functions;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	574
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	575 while (prev->next != NULL)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	576 prev = prev->next;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	577 ctx->next = NULL;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	578 ctx->function = function;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	579 ctx->interface_offset = prev->interface_offset + prev->function->interface_count;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	580 ctx->ep_rx_offset = prev->ep_rx_offset + prev->function->ep_rx_count;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	581 ctx->ep_tx_offset = prev->ep_tx_offset + prev->function->ep_tx_count;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	582 prev->next = ctx;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	583 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	584
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	585 void usb_init(const struct usbd_device *identity)
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	586 {
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	587 usb.identity = identity;
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	588 usb_enable();
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	589 }
b091bb09c55f Adding McHCK DFU Bootloader Jacob Alexander <haata@kiibohd.com> parents: diff changeset	590

Mercurial > louis > kiibohd-controller

annotate Bootloader/usb.c @ 412:e7a3be42ae1e