[proxmark3-svn] / armsrc / cmd.c

/*\r
 * Proxmark send and receive commands\r
 *\r
 * Copyright (c) 2012, Roel Verdult\r
 * All rights reserved.\r
 *\r
 * Redistribution and use in source and binary forms, with or without\r
 * modification, are permitted provided that the following conditions are met:\r
 * 1. Redistributions of source code must retain the above copyright\r
 * notice, this list of conditions and the following disclaimer.\r
 * 2. Redistributions in binary form must reproduce the above copyright\r
 * notice, this list of conditions and the following disclaimer in the\r
 * documentation and/or other materials provided with the distribution.\r
 * 3. Neither the name of the copyright holders nor the\r
 * names of its contributors may be used to endorse or promote products\r
 * derived from this software without specific prior written permission.\r
 *\r
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS ''AS IS'' AND ANY\r
 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED\r
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE\r
 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY\r
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES\r
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;\r
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND\r
 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT\r
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS\r
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.\r
 *\r
 * @file cmd.c\r
 * @brief\r
 */\r
\r
#include "cmd.h"\r
\r
#include <stddef.h>\r
#include <stdint.h>\r
#include <stdbool.h>\r
#include "common.h"\r
#include "usb_cmd.h"\r
#include "usb_cdc.h"\r
\r
\r
bool cmd_receive(UsbCommand* cmd) {\r
\r
	// Check if there is a usb packet available\r
	if (!usb_poll())\r
		return false;\r
\r
	// Try to retrieve the available command frame\r
	size_t rxlen = usb_read((uint8_t*)cmd, sizeof(UsbCommand));\r
\r
	// Check if the transfer was complete\r
	if (rxlen != sizeof(UsbCommand))\r
		return false;\r
\r
	// Received command successfully\r
	return true;\r
}\r
\r
\r
bool cmd_send(uint32_t cmd, uint32_t arg0, uint32_t arg1, uint32_t arg2, void* data, size_t len) {\r
	UsbCommand txcmd;\r
\r
	for (size_t i = 0; i < sizeof(UsbCommand); i++) {\r
		((uint8_t*)&txcmd)[i] = 0x00;\r
	}\r
\r
	// Compose the outgoing command frame\r
	txcmd.cmd = cmd;\r
	txcmd.arg[0] = arg0;\r
	txcmd.arg[1] = arg1;\r
	txcmd.arg[2] = arg2;\r
\r
	// Add the (optional) content to the frame, with a maximum size of USB_CMD_DATA_SIZE\r
	if (data && len) {\r
		len = MIN(len, USB_CMD_DATA_SIZE);\r
		for (size_t i = 0; i < len; i++) {\r
			txcmd.d.asBytes[i] = ((uint8_t*)data)[i];\r
		}\r
	}\r
\r
	// Send frame and make sure all bytes are transmitted\r
	if (usb_write((uint8_t*)&txcmd, sizeof(UsbCommand)) != 0) return false;\r
\r
	return true;\r
}\r
Commit	Line	Data
5bcc76c4	1	/*\r
	2	* Proxmark send and receive commands\r
	3	*\r
79a73ab2	4	* Copyright (c) 2012, Roel Verdult\r
5bcc76c4	5	* All rights reserved.\r
	6	*\r
	7	* Redistribution and use in source and binary forms, with or without\r
	8	* modification, are permitted provided that the following conditions are met:\r
	9	* 1. Redistributions of source code must retain the above copyright\r
	10	* notice, this list of conditions and the following disclaimer.\r
	11	* 2. Redistributions in binary form must reproduce the above copyright\r
	12	* notice, this list of conditions and the following disclaimer in the\r
	13	* documentation and/or other materials provided with the distribution.\r
	14	* 3. Neither the name of the copyright holders nor the\r
	15	* names of its contributors may be used to endorse or promote products\r
	16	* derived from this software without specific prior written permission.\r
	17	*\r
	18	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS ''AS IS'' AND ANY\r
	19	* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED\r
	20	* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE\r
	21	* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY\r
	22	* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES\r
	23	* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;\r
	24	* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND\r
	25	* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT\r
	26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS\r
	27	* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.\r
	28	*\r
	29	* @file cmd.c\r
	30	* @brief\r
	31	*/\r
	32	\r
	33	#include "cmd.h"\r
72622d64	34	\r
	35	#include <stddef.h>\r
	36	#include <stdint.h>\r
	37	#include <stdbool.h>\r
	38	#include "common.h"\r
	39	#include "usb_cmd.h"\r
	40	#include "usb_cdc.h"\r
	41	\r
5bcc76c4	42	\r
5bcc76c4	43	bool cmd_receive(UsbCommand* cmd) {\r
5bcc76c4	44	\r
72622d64	45	// Check if there is a usb packet available\r
	46	if (!usb_poll())\r
	47	return false;\r
	48	\r
	49	// Try to retrieve the available command frame\r
	50	size_t rxlen = usb_read((uint8_t*)cmd, sizeof(UsbCommand));\r
	51	\r
	52	// Check if the transfer was complete\r
	53	if (rxlen != sizeof(UsbCommand))\r
	54	return false;\r
	55	\r
	56	// Received command successfully\r
	57	return true;\r
5bcc76c4	58	}\r
5bcc76c4	59	\r
72622d64	60	\r
79a73ab2	61	bool cmd_send(uint32_t cmd, uint32_t arg0, uint32_t arg1, uint32_t arg2, void* data, size_t len) {\r
72622d64	62	UsbCommand txcmd;\r
5bcc76c4	63	\r
72622d64	64	for (size_t i = 0; i < sizeof(UsbCommand); i++) {\r
	65	((uint8_t*)&txcmd)[i] = 0x00;\r
	66	}\r
5bcc76c4	67	\r
72622d64	68	// Compose the outgoing command frame\r
	69	txcmd.cmd = cmd;\r
	70	txcmd.arg[0] = arg0;\r
	71	txcmd.arg[1] = arg1;\r
	72	txcmd.arg[2] = arg2;\r
5bcc76c4	73	\r
72622d64	74	// Add the (optional) content to the frame, with a maximum size of USB_CMD_DATA_SIZE\r
	75	if (data && len) {\r
	76	len = MIN(len, USB_CMD_DATA_SIZE);\r
	77	for (size_t i = 0; i < len; i++) {\r
	78	txcmd.d.asBytes[i] = ((uint8_t*)data)[i];\r
	79	}\r
	80	}\r
5bcc76c4	81	\r
72622d64	82	// Send frame and make sure all bytes are transmitted\r
	83	if (usb_write((uint8_t*)&txcmd, sizeof(UsbCommand)) != 0) return false;\r
	84	\r
	85	return true;\r
	86	}\r