pixy2 smart camera library www.pixycam.com

Pixy2 Library project (using UART interface)

Committer:
haarkon
Date:
Mon Mar 11 17:18:25 2019 +0000
Revision:
5:28e47187bb5c
Parent:
4:eed638064b42
Child:
6:e9e3aa6f1a55
Last release of the day (still very imcomplete)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
haarkon 0:dde1b9d6c9d6 1 /**
haarkon 0:dde1b9d6c9d6 2 * @author Hugues Angelis
haarkon 0:dde1b9d6c9d6 3 *
haarkon 0:dde1b9d6c9d6 4 * @section LICENSE
haarkon 0:dde1b9d6c9d6 5 *
haarkon 0:dde1b9d6c9d6 6 * Permission is hereby granted, free of charge, to any person obtaining a copy
haarkon 0:dde1b9d6c9d6 7 * of this software and associated documentation files (the "Software"), to deal
haarkon 0:dde1b9d6c9d6 8 * in the Software without restriction, including without limitation the rights
haarkon 0:dde1b9d6c9d6 9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
haarkon 0:dde1b9d6c9d6 10 * copies of the Software, and to permit persons to whom the Software is
haarkon 0:dde1b9d6c9d6 11 * furnished to do so, subject to the following conditions:
haarkon 0:dde1b9d6c9d6 12 *
haarkon 0:dde1b9d6c9d6 13 * The above copyright notice and this permission notice shall be included in
haarkon 0:dde1b9d6c9d6 14 * all copies or substantial portions of the Software.
haarkon 0:dde1b9d6c9d6 15 *
haarkon 0:dde1b9d6c9d6 16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
haarkon 0:dde1b9d6c9d6 17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
haarkon 0:dde1b9d6c9d6 18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
haarkon 0:dde1b9d6c9d6 19 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
haarkon 0:dde1b9d6c9d6 20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
haarkon 0:dde1b9d6c9d6 21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
haarkon 0:dde1b9d6c9d6 22 * THE SOFTWARE.
haarkon 0:dde1b9d6c9d6 23 *
haarkon 0:dde1b9d6c9d6 24 * @section DESCRIPTION
haarkon 0:dde1b9d6c9d6 25 *
haarkon 0:dde1b9d6c9d6 26 * CMUCAM 5 - Pixy2
haarkon 0:dde1b9d6c9d6 27 *
haarkon 0:dde1b9d6c9d6 28 * Datasheet, FAQ and PC drivers :
haarkon 0:dde1b9d6c9d6 29 *
haarkon 0:dde1b9d6c9d6 30 * http://www.pixycam.com/
haarkon 0:dde1b9d6c9d6 31 */
haarkon 0:dde1b9d6c9d6 32
haarkon 0:dde1b9d6c9d6 33 #ifndef _PIXY2_
haarkon 0:dde1b9d6c9d6 34 #define _PIXY2_
haarkon 0:dde1b9d6c9d6 35
haarkon 0:dde1b9d6c9d6 36 /**
haarkon 0:dde1b9d6c9d6 37 * Include : Mbed Library
haarkon 0:dde1b9d6c9d6 38 */
haarkon 0:dde1b9d6c9d6 39 #include "mbed.h"
haarkon 0:dde1b9d6c9d6 40
haarkon 0:dde1b9d6c9d6 41 /**
haarkon 0:dde1b9d6c9d6 42 * Defines
haarkon 0:dde1b9d6c9d6 43 */
haarkon 0:dde1b9d6c9d6 44 #define PIXY2_NCSHEADERSIZE 4
haarkon 0:dde1b9d6c9d6 45 #define PIXY2_CSHEADERSIZE 4
haarkon 0:dde1b9d6c9d6 46 #define PIXY2_SYNC 0xC1AE
haarkon 0:dde1b9d6c9d6 47 #define PIXY2_CSSYNC 0xC1AF
haarkon 0:dde1b9d6c9d6 48 #define PIXY2_ACK 1
haarkon 0:dde1b9d6c9d6 49 #define PIXY2_ASK_RESOL 12
haarkon 0:dde1b9d6c9d6 50 #define PIXY2_REP_RESOL 13
haarkon 0:dde1b9d6c9d6 51 #define PIXY2_ASK_VERS 14
haarkon 0:dde1b9d6c9d6 52 #define PIXY2_REP_VERS 15
haarkon 0:dde1b9d6c9d6 53 #define PIXY2_SET_BRIGHT 16
haarkon 0:dde1b9d6c9d6 54 #define PIXY2_SET_SERVOS 18
haarkon 0:dde1b9d6c9d6 55 #define PIXY2_SET_LED 20
haarkon 0:dde1b9d6c9d6 56 #define PIXY2_SET_LAMP 22
haarkon 0:dde1b9d6c9d6 57 #define PIXY2_ASK_FPS 24
haarkon 0:dde1b9d6c9d6 58 #define PIXY2_ASK_BLOC 32
haarkon 0:dde1b9d6c9d6 59 #define PIXY2_REP_BLOC 33
haarkon 0:dde1b9d6c9d6 60 #define PIXY2_ASK_LINE 48
haarkon 0:dde1b9d6c9d6 61 #define PIXY2_REP_LINE 49
haarkon 0:dde1b9d6c9d6 62 #define PIXY2_SET_MODE 54
haarkon 0:dde1b9d6c9d6 63 #define PIXY2_SET_TURN 58
haarkon 0:dde1b9d6c9d6 64 #define PIXY2_SET_VECTOR 56
haarkon 0:dde1b9d6c9d6 65 #define PIXY2_SET_DEFTURN 60
haarkon 0:dde1b9d6c9d6 66 #define PIXY2_SET_REVERSE 62
haarkon 0:dde1b9d6c9d6 67 #define PIXY2_ASK_VIDEO 112
haarkon 1:dd81f4065b6b 68
haarkon 5:28e47187bb5c 69 /**************** UTILS ****************/
haarkon 5:28e47187bb5c 70
haarkon 5:28e47187bb5c 71 /**
haarkon 5:28e47187bb5c 72 * \enum error_code
haarkon 5:28e47187bb5c 73 * \brief List of possible error code
haarkon 5:28e47187bb5c 74 * \param PIXY2_OK : No error
haarkon 5:28e47187bb5c 75 * \param PIXY2_MISC_ERROR : Unknown error
haarkon 5:28e47187bb5c 76 * \param PIXY2_BUSY : Pixy hasn't finish yet
haarkon 5:28e47187bb5c 77 * \param PIXY2_BAD_CHECKSUM : Checksum is wrong
haarkon 5:28e47187bb5c 78 * \param PIXY2_TYPE_ERROR : unexpected type message
haarkon 5:28e47187bb5c 79 */
haarkon 5:28e47187bb5c 80
haarkon 5:28e47187bb5c 81 #define PIXY2_OK 0
haarkon 5:28e47187bb5c 82 #define PIXY2_MISC_ERROR -1
haarkon 5:28e47187bb5c 83 #define PIXY2_BUSY -2
haarkon 5:28e47187bb5c 84 #define PIXY2_BAD_CHECKSUM -3
haarkon 5:28e47187bb5c 85 #define PIXY2_TYPE_ERROR -7
haarkon 1:dd81f4065b6b 86
haarkon 1:dd81f4065b6b 87 /**************** STATE MACHINE ****************/
haarkon 1:dd81f4065b6b 88
haarkon 1:dd81f4065b6b 89 typedef enum {idle, messageSent, receivingHeader, headerReceived, receivingData, dataReceived} T_Pixy2State;
haarkon 1:dd81f4065b6b 90
haarkon 1:dd81f4065b6b 91 /**************** UTILS ****************/
haarkon 1:dd81f4065b6b 92
haarkon 0:dde1b9d6c9d6 93 /**
haarkon 0:dde1b9d6c9d6 94 * \struct Byte -> Short hand for unsigned char
haarkon 2:5281a6289e8b 95 * \struct sByte -> Short hand for char
haarkon 0:dde1b9d6c9d6 96 * \struct Word -> Short hand for unsigned short
haarkon 2:5281a6289e8b 97 * \struct sWord -> Short hand for short
haarkon 0:dde1b9d6c9d6 98 * \struct lWord -> Short hand for unsigned long
haarkon 2:5281a6289e8b 99 * \struct slWord -> Short hand for long
haarkon 0:dde1b9d6c9d6 100 */
haarkon 0:dde1b9d6c9d6 101 typedef unsigned char Byte;
haarkon 2:5281a6289e8b 102 typedef char sByte;
haarkon 0:dde1b9d6c9d6 103 typedef unsigned short Word;
haarkon 2:5281a6289e8b 104 typedef short sWord;
haarkon 0:dde1b9d6c9d6 105 typedef unsigned long lWord;
haarkon 2:5281a6289e8b 106 typedef long slWord;
haarkon 0:dde1b9d6c9d6 107
haarkon 1:dd81f4065b6b 108 /**
haarkon 1:dd81f4065b6b 109 * \union T_Word
haarkon 1:dd81f4065b6b 110 * \brief Structured type to switch from word to bytes
haarkon 1:dd81f4065b6b 111 * \param mot (Word) : 16 bits word
haarkon 1:dd81f4065b6b 112 * \param octet (Byte) : 2 bytes that overlap mot (byte access)
haarkon 1:dd81f4065b6b 113 */
haarkon 0:dde1b9d6c9d6 114 typedef union {
haarkon 0:dde1b9d6c9d6 115 Word mot;
haarkon 0:dde1b9d6c9d6 116 Byte octet[2];
haarkon 0:dde1b9d6c9d6 117 }T_Word;
haarkon 0:dde1b9d6c9d6 118
haarkon 1:dd81f4065b6b 119 /**
haarkon 1:dd81f4065b6b 120 * \union T_lWord
haarkon 1:dd81f4065b6b 121 * \brief Structured type to switch from lword to word or bytes
haarkon 1:dd81f4065b6b 122 * \param motLong (lWord) : 32 bits word
haarkon 1:dd81f4065b6b 123 * \param mot (Word) : 2 x 16 bits words that overlap motLong (word access)
haarkon 1:dd81f4065b6b 124 * \param octet (Byte) : 4 bytes that overlap motLong (byte access)
haarkon 1:dd81f4065b6b 125 */
haarkon 0:dde1b9d6c9d6 126 typedef union {
haarkon 0:dde1b9d6c9d6 127 lWord motLong;
haarkon 0:dde1b9d6c9d6 128 Word mot[2];
haarkon 0:dde1b9d6c9d6 129 Byte octet[4];
haarkon 0:dde1b9d6c9d6 130 }T_lWord;
haarkon 0:dde1b9d6c9d6 131
haarkon 1:dd81f4065b6b 132
haarkon 1:dd81f4065b6b 133 /**************** HEADERS ****************/
haarkon 1:dd81f4065b6b 134
haarkon 1:dd81f4065b6b 135 /**
haarkon 1:dd81f4065b6b 136 * \struct T_pixy2Header
haarkon 1:dd81f4065b6b 137 * \brief Structured type that match pixy2 header without checksum (send message)
haarkon 1:dd81f4065b6b 138 * \param pixSync (Word) : 16 bits synchro word - could be 0xc1ae (PIXY2_SYNC) or 0xc1af (PIXY2_CSSYNC)
haarkon 1:dd81f4065b6b 139 * \param pixType (Byte) : 8 bits message type identifier
haarkon 1:dd81f4065b6b 140 * \param pixLength (Byte) : 8 bits message payload length (payload doesn't include checksum)
haarkon 1:dd81f4065b6b 141 */
haarkon 0:dde1b9d6c9d6 142 typedef struct {
haarkon 0:dde1b9d6c9d6 143 Word pixSync;
haarkon 0:dde1b9d6c9d6 144 Byte pixType;
haarkon 0:dde1b9d6c9d6 145 Byte pixLength;
haarkon 0:dde1b9d6c9d6 146 }T_pixy2Header;
haarkon 0:dde1b9d6c9d6 147
haarkon 1:dd81f4065b6b 148 /**
haarkon 1:dd81f4065b6b 149 * \struct T_pixy2sendFrame
haarkon 1:dd81f4065b6b 150 * \brief Structured type that match frame definition for all kind of message to send to a pixy2
haarkon 1:dd81f4065b6b 151 * \param header (T_pixy2Header) : 4 bytes classical header starting with PIXY2_SYNC
haarkon 1:dd81f4065b6b 152 * \param data (Byte) : 5 bytes payload (to match all usage, not all byte must be used)
haarkon 1:dd81f4065b6b 153 */
haarkon 0:dde1b9d6c9d6 154 typedef struct {
haarkon 0:dde1b9d6c9d6 155 T_pixy2Header header;
haarkon 0:dde1b9d6c9d6 156 Byte data[5];
haarkon 0:dde1b9d6c9d6 157 }T_pixy2sendFrame;
haarkon 0:dde1b9d6c9d6 158
haarkon 1:dd81f4065b6b 159 /**
haarkon 1:dd81f4065b6b 160 * \union T_pixy2sendBuffer
haarkon 1:dd81f4065b6b 161 * \brief Structured type to switch between structured type T_pixy2sendFrame and bytes
haarkon 1:dd81f4065b6b 162 * \param frame (T_pixy2sendFrame) : classical frame (header + payload) starting with PIXY2_SYNC
haarkon 1:dd81f4065b6b 163 * \param data (Byte) : 9 bytes that overlap frame (byte access)
haarkon 1:dd81f4065b6b 164 */
haarkon 0:dde1b9d6c9d6 165 typedef union {
haarkon 0:dde1b9d6c9d6 166 T_pixy2sendFrame frame;
haarkon 0:dde1b9d6c9d6 167 Byte data[9];
haarkon 0:dde1b9d6c9d6 168 }T_pixy2sendBuffer;
haarkon 0:dde1b9d6c9d6 169
haarkon 1:dd81f4065b6b 170 /**
haarkon 1:dd81f4065b6b 171 * \struct T_pixy2RcvHeader
haarkon 1:dd81f4065b6b 172 * \brief Structured type that match pixy2 header with checksum (received message)
haarkon 1:dd81f4065b6b 173 * \param pixSync (Word) : 16 bits synchro word - could be 0xc1ae (PIXY2_SYNC) or 0xc1af (PIXY2_CSSYNC)
haarkon 1:dd81f4065b6b 174 * \param pixType (Byte) : 8 bits message type identifier
haarkon 1:dd81f4065b6b 175 * \param pixLength (Byte) : 8 bits message payload length (payload doesn't include checksum)
haarkon 1:dd81f4065b6b 176 * \param pixSync (Word) : 16 bits checksum (sum of all bytes of the payload)
haarkon 1:dd81f4065b6b 177 */
haarkon 0:dde1b9d6c9d6 178 typedef struct {
haarkon 0:dde1b9d6c9d6 179 Word pixSync;
haarkon 0:dde1b9d6c9d6 180 Byte pixType;
haarkon 0:dde1b9d6c9d6 181 Byte pixLength;
haarkon 0:dde1b9d6c9d6 182 Word pixChecksum;
haarkon 0:dde1b9d6c9d6 183 }T_pixy2RcvHeader;
haarkon 0:dde1b9d6c9d6 184
haarkon 1:dd81f4065b6b 185
haarkon 1:dd81f4065b6b 186 /**************** PAYLOADS ****************/
haarkon 1:dd81f4065b6b 187
haarkon 1:dd81f4065b6b 188 /**
haarkon 1:dd81f4065b6b 189 * \struct T_pixy2returnCode
haarkon 1:dd81f4065b6b 190 * \brief Structured type that match pixy2 error/acknowledge/reply frame (type = 1 or 3) message payload
haarkon 1:dd81f4065b6b 191 * \param pixReturn (lWord) : 32 bits returned value
haarkon 1:dd81f4065b6b 192 */
haarkon 0:dde1b9d6c9d6 193 typedef struct {
haarkon 1:dd81f4065b6b 194 lWord pixReturn;
haarkon 1:dd81f4065b6b 195 }T_pixy2returnCode;
haarkon 0:dde1b9d6c9d6 196
haarkon 1:dd81f4065b6b 197 /**
haarkon 1:dd81f4065b6b 198 * \struct T_Pixy2Version
haarkon 1:dd81f4065b6b 199 * \brief Structured type that match pixy2 version frame (type = 14/15) message payload
haarkon 1:dd81f4065b6b 200 * \param pixHWVersion (Word) : 16 bits hardWare Version of pixy2
haarkon 1:dd81f4065b6b 201 * \param pixFWVersionMaj (Byte) : 8 bits upper part of firmware (before the dot)
haarkon 1:dd81f4065b6b 202 * \param pixFWVersionMin (Byte) : 8 bits lower part of firmware (after the dot)
haarkon 1:dd81f4065b6b 203 * \param pixFWBuild (Word) : 16 bits firmware build information
haarkon 1:dd81f4065b6b 204 * \param pixHFString (String) : 10 bytes user friendly pixy2 firmware type
haarkon 1:dd81f4065b6b 205 */
haarkon 0:dde1b9d6c9d6 206 typedef struct {
haarkon 0:dde1b9d6c9d6 207 Word pixHWVersion;
haarkon 0:dde1b9d6c9d6 208 Byte pixFWVersionMaj;
haarkon 0:dde1b9d6c9d6 209 Byte pixFWVersionMin;
haarkon 0:dde1b9d6c9d6 210 Word pixFWBuild;
haarkon 0:dde1b9d6c9d6 211 char pixHFString[10];
haarkon 0:dde1b9d6c9d6 212 }T_Pixy2Version;
haarkon 0:dde1b9d6c9d6 213
haarkon 1:dd81f4065b6b 214 /**
haarkon 1:dd81f4065b6b 215 * \struct T_Pixy2Resolution
haarkon 1:dd81f4065b6b 216 * \brief Structured type that match pixy2 resolution frame (type = 12/13) message payload
haarkon 1:dd81f4065b6b 217 * \param pixFrameWidth (Word) : 16 bits width (in pixel) of an image
haarkon 5:28e47187bb5c 218 * \param pixFrameHeight (Word) : 16 bits height (in pixel) of an image
haarkon 1:dd81f4065b6b 219 */
haarkon 0:dde1b9d6c9d6 220 typedef struct {
haarkon 0:dde1b9d6c9d6 221 Word pixFrameWidth;
haarkon 5:28e47187bb5c 222 Word pixFrameHeight;
haarkon 0:dde1b9d6c9d6 223 }T_Pixy2Resolution;
haarkon 0:dde1b9d6c9d6 224
haarkon 1:dd81f4065b6b 225 /**
haarkon 1:dd81f4065b6b 226 * \struct T_pixy2Bloc
haarkon 1:dd81f4065b6b 227 * \brief Structured type that match pixy2 blocks frame (type = 32/33) message payload
haarkon 1:dd81f4065b6b 228 * \param pixSignature (Word) : 16 bits signature or color code of the color bloc (signature are between 1 and 7, color code are composed of signature of 2, up to 5, tags so over 10)
haarkon 1:dd81f4065b6b 229 * \param pixX (Word) : 16 bits X (horizontal axis) position of color bloc center, relative to the left of the image (in pixels, between 0 and 315)
haarkon 1:dd81f4065b6b 230 * \param pixY (Word) : 16 bits Y (vertical axis) position of color bloc center, relative to the top of the image (in pixels, between 0 and 207)
haarkon 1:dd81f4065b6b 231 * \param pixWidth (Word) : 16 bits width (in pixels, between 0 and 316) of color bloc
haarkon 1:dd81f4065b6b 232 * \param pixHeight (Word) : 16 bits height (in pixels, between 0 and 208) of color bloc
haarkon 2:5281a6289e8b 233 * \param pixAngle (sWord) : 16 bits angle (in degree, between -180.0 and +180.0) of a color code bloc
haarkon 1:dd81f4065b6b 234 * \param pixIndex (Byte) : 8 bits tracking identification of the color code bloc (set by pixy2 to ease a bloc position following program)
haarkon 1:dd81f4065b6b 235 * \param pixAge (Byte) : 8 bits age (in number of frame) of a bloc (doesn't wrap around).
haarkon 1:dd81f4065b6b 236 * @note More info can be found here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:ccc_api
haarkon 1:dd81f4065b6b 237 * @note or here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:color_connected_components
haarkon 1:dd81f4065b6b 238 */
haarkon 0:dde1b9d6c9d6 239 typedef struct {
haarkon 0:dde1b9d6c9d6 240 Word pixSignature;
haarkon 0:dde1b9d6c9d6 241 Word pixX;
haarkon 0:dde1b9d6c9d6 242 Word pixY;
haarkon 0:dde1b9d6c9d6 243 Word pixWidth;
haarkon 0:dde1b9d6c9d6 244 Word pixHeight;
haarkon 2:5281a6289e8b 245 sWord pixAngle;
haarkon 0:dde1b9d6c9d6 246 Byte pixIndex;
haarkon 0:dde1b9d6c9d6 247 Byte pixAge;
haarkon 0:dde1b9d6c9d6 248 }T_pixy2Bloc;
haarkon 0:dde1b9d6c9d6 249
haarkon 1:dd81f4065b6b 250 /**
haarkon 1:dd81f4065b6b 251 * \struct T_Pixy2Vector
haarkon 1:dd81f4065b6b 252 * \brief Structured type that match pixy2 vector definition - used in Line frame (type 48/49) - message payload
haarkon 2:5281a6289e8b 253 * \param pixX0 (Byte) : 8 bits X (horizontal, relative to the left of image) position of the tail of the vector (number between 0 and 78)
haarkon 2:5281a6289e8b 254 * \param pixY0 (Byte) : 8 bits Y (vertical, relative to the top of image) position of the tail of the vector (number between 0 and 51)
haarkon 2:5281a6289e8b 255 * \param pixX1 (Byte) : 8 bits X (horizontal, relative to the left of image) position of the head of the vector (number between 0 and 78)
haarkon 2:5281a6289e8b 256 * \param pixY1 (Byte) : 8 bits Y (vertical, relative to the top of image) position of the head of the vector (number between 0 and 51)
haarkon 2:5281a6289e8b 257 * \param pixIndex (Byte) : 8 bits tracking identification of the vector (set by pixy2 to ease a vector identification in case of multiple vector in a line following program)
haarkon 2:5281a6289e8b 258 * \param pixFlags (Byte) : 8 bits flag containing possible usefull informations (see notes)
haarkon 4:eed638064b42 259 * @note This structure is a feature of Line API, packed as a feature in a Line Frame, documented here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:protocol_reference
haarkon 2:5281a6289e8b 260 * @note More info can be found here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_api
haarkon 2:5281a6289e8b 261 * @note or here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_tracking
haarkon 1:dd81f4065b6b 262 */
haarkon 0:dde1b9d6c9d6 263 typedef struct {
haarkon 0:dde1b9d6c9d6 264 Byte pixX0;
haarkon 0:dde1b9d6c9d6 265 Byte pixY0;
haarkon 0:dde1b9d6c9d6 266 Byte pixX1;
haarkon 0:dde1b9d6c9d6 267 Byte pixY1;
haarkon 0:dde1b9d6c9d6 268 Byte pixIndex;
haarkon 0:dde1b9d6c9d6 269 Byte pixFlags;
haarkon 0:dde1b9d6c9d6 270 }T_Pixy2Vector;
haarkon 0:dde1b9d6c9d6 271
haarkon 2:5281a6289e8b 272 /**
haarkon 2:5281a6289e8b 273 * \struct T_Pixy2InterLine
haarkon 2:5281a6289e8b 274 * \brief Structured type that match pixy2 intersection line definition - used in Line frame (type 48/49) - message payload
haarkon 2:5281a6289e8b 275 * \param pixIndex (Byte) : 8 bits tracking identification of the intersection line (set by pixy2 to ease a line following program)
haarkon 2:5281a6289e8b 276 * \param pixReserved (Byte) : Not documented by manufacturer
haarkon 2:5281a6289e8b 277 * \param pixAngle (sWord) : 16 bits angle (in degree, between -180.0 and +180.0) of the intersection line
haarkon 4:eed638064b42 278 * @note This structure is a sub feature of Line API, packed as a sub feature of intersection feature in a Line Frame, documented here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:protocol_reference
haarkon 2:5281a6289e8b 279 * @note More info can be found here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_api
haarkon 2:5281a6289e8b 280 * @note or here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_tracking
haarkon 2:5281a6289e8b 281 */
haarkon 0:dde1b9d6c9d6 282 typedef struct {
haarkon 0:dde1b9d6c9d6 283 Byte pixIndex;
haarkon 0:dde1b9d6c9d6 284 Byte pixReserved;
haarkon 2:5281a6289e8b 285 sWord pixAngle;
haarkon 0:dde1b9d6c9d6 286 }T_Pixy2InterLine;
haarkon 0:dde1b9d6c9d6 287
haarkon 3:6ba43af28440 288 /**
haarkon 3:6ba43af28440 289 * \struct T_pixy2Intersection
haarkon 3:6ba43af28440 290 * \brief Structured type that match pixy2 intersection definition - used in Line frame (type 48/49) - message payload
haarkon 3:6ba43af28440 291 * \param pixX (Byte) : X axis coordinate of the intersection (in pixel, between 0 and 78)
haarkon 3:6ba43af28440 292 * \param pixY (Byte) : Y axis coordinate of the intersection (in pixel, between 0 and 51)
haarkon 3:6ba43af28440 293 * \param pixN (Byte) : Number of lines connected to the intersection (between 3 and 5)
haarkon 3:6ba43af28440 294 * \param pixReserved (Byte) : Not documented by manufacturer
haarkon 4:eed638064b42 295 * @note This structure is a feature of Line API, packed as a feature in a Line Frame, documented here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:protocol_reference
haarkon 3:6ba43af28440 296 * @note More info can be found here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_api
haarkon 3:6ba43af28440 297 * @note or here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_tracking
haarkon 3:6ba43af28440 298 */
haarkon 0:dde1b9d6c9d6 299 typedef struct {
haarkon 0:dde1b9d6c9d6 300 Byte pixX;
haarkon 0:dde1b9d6c9d6 301 Byte pixY;
haarkon 0:dde1b9d6c9d6 302 Byte pixN;
haarkon 0:dde1b9d6c9d6 303 Byte pixReserved;
haarkon 0:dde1b9d6c9d6 304 }T_pixy2Intersection;
haarkon 0:dde1b9d6c9d6 305
haarkon 3:6ba43af28440 306 /**
haarkon 3:6ba43af28440 307 * \struct T_pixy2BarCode
haarkon 3:6ba43af28440 308 * \brief Structured type that match pixy2 barcode definition - used in Line frame (type 48/49) - message payload
haarkon 3:6ba43af28440 309 * \param pixX (Byte) : X axis coordinate of the barcode (in pixel, between 0 and 78)
haarkon 3:6ba43af28440 310 * \param pixY (Byte) : Y axis coordinate of the barcode (in pixel, between 0 and 51)
haarkon 3:6ba43af28440 311 * \param pixFlag (Byte) : Flag to indicate if barcode met filtering constraint
haarkon 3:6ba43af28440 312 * \param pixCode (Byte) : Indicate the numeric value associated with the barcode (between 0 and 15)
haarkon 4:eed638064b42 313 * @note This structure is a feature of Line API, packed as a feature in a Line Frame, documented here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:protocol_reference
haarkon 3:6ba43af28440 314 * @note More info can be found here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_api
haarkon 3:6ba43af28440 315 * @note or here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_tracking
haarkon 3:6ba43af28440 316 */
haarkon 0:dde1b9d6c9d6 317 typedef struct {
haarkon 0:dde1b9d6c9d6 318 Byte pixX;
haarkon 0:dde1b9d6c9d6 319 Byte pixY;
haarkon 0:dde1b9d6c9d6 320 Byte pixFlag;
haarkon 0:dde1b9d6c9d6 321 Byte pixCode;
haarkon 0:dde1b9d6c9d6 322 }T_pixy2BarCode;
haarkon 0:dde1b9d6c9d6 323
haarkon 4:eed638064b42 324 /**
haarkon 4:eed638064b42 325 * \struct T_pixy2LineFeature
haarkon 4:eed638064b42 326 * \brief Structured type that match pixy2 feature header for Line API - used in Line frame (type 48/49) - message payload
haarkon 4:eed638064b42 327 * \param pixType (Byte) : Type of the feature (can be 1 -> Vector, 2 -> Intersection or 4 -> Barcode)
haarkon 4:eed638064b42 328 * \param pixLength (Byte) : Number of Bytes for this feature
haarkon 4:eed638064b42 329 * @note This structure is the header of features of Line API in Line Frames. Ther can be up to 4 features in a frame. Documented here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:protocol_reference
haarkon 4:eed638064b42 330 * @note More info can be found here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_api
haarkon 4:eed638064b42 331 * @note or here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:line_tracking
haarkon 4:eed638064b42 332 */
haarkon 0:dde1b9d6c9d6 333 typedef struct {
haarkon 0:dde1b9d6c9d6 334 Byte pixType;
haarkon 0:dde1b9d6c9d6 335 Byte pixLength;
haarkon 0:dde1b9d6c9d6 336 }T_pixy2LineFeature;
haarkon 0:dde1b9d6c9d6 337
haarkon 4:eed638064b42 338 /**
haarkon 4:eed638064b42 339 * \struct T_pixy2Pixel
haarkon 4:eed638064b42 340 * \brief Structured type that match pixy2 video API - used in Video frame (type 112/1) - message payload
haarkon 4:eed638064b42 341 * \param pixBlue (Byte) : Blue RGB value of the average blue component of the 5x5 pixels square centered on X param passes to the function (value between 0 and 255)
haarkon 4:eed638064b42 342 * \param pixGreen (Byte) : Green RGB value of the average blue component of the 5x5 pixels square centered on X param passes to the function (value between 0 and 255)
haarkon 4:eed638064b42 343 * \param pixRed (Byte) : Red RGB value of the average blue component of the 5x5 pixels square centered on X param passes to the function (value between 0 and 255)
haarkon 4:eed638064b42 344 * @note More info can be found here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:video_api
haarkon 4:eed638064b42 345 * @note or here : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:video
haarkon 4:eed638064b42 346 */
haarkon 0:dde1b9d6c9d6 347 typedef struct {
haarkon 0:dde1b9d6c9d6 348 Byte pixBlue;
haarkon 0:dde1b9d6c9d6 349 Byte pixGreen;
haarkon 0:dde1b9d6c9d6 350 Byte pixRed;
haarkon 0:dde1b9d6c9d6 351 }T_pixy2Pixel;
haarkon 0:dde1b9d6c9d6 352
haarkon 0:dde1b9d6c9d6 353 /**
haarkon 0:dde1b9d6c9d6 354 * Pixy2 : CMU CAM 5 - Smart camera
haarkon 0:dde1b9d6c9d6 355 * More informations at http://www.pixycam.com/
haarkon 0:dde1b9d6c9d6 356 */
haarkon 0:dde1b9d6c9d6 357 class PIXY2 {
haarkon 0:dde1b9d6c9d6 358
haarkon 0:dde1b9d6c9d6 359 protected :
haarkon 0:dde1b9d6c9d6 360
haarkon 0:dde1b9d6c9d6 361 Serial* _Pixy2;
haarkon 0:dde1b9d6c9d6 362
haarkon 0:dde1b9d6c9d6 363 public :
haarkon 0:dde1b9d6c9d6 364 /**
haarkon 0:dde1b9d6c9d6 365 * Constructor of pixy2 object.
haarkon 0:dde1b9d6c9d6 366 *
haarkon 0:dde1b9d6c9d6 367 * @param tx : the Mbed pin used as TX
haarkon 0:dde1b9d6c9d6 368 * @param rx : the Mbed pin used as RX
haarkon 0:dde1b9d6c9d6 369 * @param debit : the bitrate of the serial (max value is 230400 b/s)
haarkon 0:dde1b9d6c9d6 370 */
haarkon 0:dde1b9d6c9d6 371 PIXY2(PinName tx, PinName rx, int debit = 230400);
haarkon 0:dde1b9d6c9d6 372
haarkon 0:dde1b9d6c9d6 373 // Fonctions publiques
haarkon 3:6ba43af28440 374
haarkon 3:6ba43af28440 375 /**
haarkon 5:28e47187bb5c 376 * Queries and receives the firmware and hardware version of Pixy2, which is put in the version member variable.
haarkon 5:28e47187bb5c 377 * @note Frame Documentation : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:porting_guide
haarkon 5:28e47187bb5c 378 * @note Function Documentation : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:general_api
haarkon 5:28e47187bb5c 379 * @param version (T_Pixy2Version - passed by reference) : pointer to the version data structure
haarkon 5:28e47187bb5c 380 * @return int : error code.
haarkon 3:6ba43af28440 381 */
haarkon 0:dde1b9d6c9d6 382 int pixy2_getVersion (T_Pixy2Version *version);
haarkon 4:eed638064b42 383
haarkon 4:eed638064b42 384 /**
haarkon 5:28e47187bb5c 385 * Gets the width and height of the frames used by the current program.
haarkon 5:28e47187bb5c 386 * @note After calling this function, the width and height can be found in the frameWidth and frameHeight member variables.
haarkon 5:28e47187bb5c 387 * @note Frame Documentation : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:porting_guide
haarkon 5:28e47187bb5c 388 * @note Function Documentation : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:general_api
haarkon 5:28e47187bb5c 389 * @param resolution (T_Pixy2Resolution - passed by reference) : pointer to the resolution data structure
haarkon 5:28e47187bb5c 390 * @return int : error code.
haarkon 4:eed638064b42 391 */
haarkon 0:dde1b9d6c9d6 392 int pixy2_getResolution (T_Pixy2Resolution *resolution);
haarkon 5:28e47187bb5c 393
haarkon 5:28e47187bb5c 394 /**
haarkon 5:28e47187bb5c 395 * Sets the relative exposure level of Pixy2's image sensor. Higher values result in a brighter (more exposed) image.
haarkon 5:28e47187bb5c 396 * @note Frame Documentation : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:porting_guide
haarkon 5:28e47187bb5c 397 * @note Function Documentation : https://docs.pixycam.com/wiki/doku.php?id=wiki:v2:general_api
haarkon 5:28e47187bb5c 398 * @param brightness (Byte - passed by value) : brightness level
haarkon 5:28e47187bb5c 399 * @return int : error code.
haarkon 5:28e47187bb5c 400 */
haarkon 0:dde1b9d6c9d6 401 int pixy2_setCameraBrightness (Byte brightness);
haarkon 0:dde1b9d6c9d6 402 int pixy2_setServos (Word s0, Word s1);
haarkon 0:dde1b9d6c9d6 403 int pixy2_setLED (Byte red, Byte green, Byte blue);
haarkon 0:dde1b9d6c9d6 404 int pixy2_setLamp (Byte upper, Byte lower);
haarkon 1:dd81f4065b6b 405 int pixy2_getFPS (T_pixy2returnCode *framerate);
haarkon 0:dde1b9d6c9d6 406 int pixy2_getBlocks (Byte sigmap, Byte maxBloc);
haarkon 0:dde1b9d6c9d6 407 int pixy2_getMainFeature (Byte type, Byte features);
haarkon 0:dde1b9d6c9d6 408 int pixy2_getAllFeature (Byte features);
haarkon 0:dde1b9d6c9d6 409 int pixy2_setMode (Byte mode);
haarkon 0:dde1b9d6c9d6 410 int pixy2_setNexTurn (Word angle);
haarkon 0:dde1b9d6c9d6 411 int pixy2_setDefaultTurn (Word angle);
haarkon 0:dde1b9d6c9d6 412 int pixy2_setVector (Byte vectorIndex);
haarkon 0:dde1b9d6c9d6 413 int pixy2_ReverseVector (void);
haarkon 0:dde1b9d6c9d6 414 int pixy2_getRGB (Word x, Word y, Byte saturate, T_pixy2Pixel *pixel);
haarkon 0:dde1b9d6c9d6 415
haarkon 0:dde1b9d6c9d6 416 // Variables globales Publiques
haarkon 0:dde1b9d6c9d6 417 Byte Pixy2_numBlocks;
haarkon 0:dde1b9d6c9d6 418 T_pixy2Bloc Pixy2_blocks[];
haarkon 0:dde1b9d6c9d6 419 Byte Pixy2_numVectors;
haarkon 0:dde1b9d6c9d6 420 T_Pixy2Vector Pixy2_vectors[];
haarkon 0:dde1b9d6c9d6 421 Byte Pixy2_numIntersections;
haarkon 0:dde1b9d6c9d6 422 T_pixy2Intersection Pixy2_intersections[];
haarkon 0:dde1b9d6c9d6 423 T_Pixy2InterLine Pixy2_intLines[];
haarkon 0:dde1b9d6c9d6 424 Byte Pixy2_numBarcodes;
haarkon 0:dde1b9d6c9d6 425 T_pixy2BarCode Pixy2_barcodes[];
haarkon 0:dde1b9d6c9d6 426
haarkon 0:dde1b9d6c9d6 427 private :
haarkon 0:dde1b9d6c9d6 428 // Variables globales Privées
haarkon 0:dde1b9d6c9d6 429 T_Pixy2State etat;
haarkon 0:dde1b9d6c9d6 430 Byte* Pixy2_buffer;
haarkon 0:dde1b9d6c9d6 431 Byte wPointer, rPointer, dataSize;
haarkon 0:dde1b9d6c9d6 432 Byte frameContainChecksum;
haarkon 0:dde1b9d6c9d6 433
haarkon 0:dde1b9d6c9d6 434 // Fonctions privées
haarkon 0:dde1b9d6c9d6 435 int pixy2_sndGetVersion (void);
haarkon 0:dde1b9d6c9d6 436 int pixy2_sndGetResolution (void);
haarkon 0:dde1b9d6c9d6 437 int pixy2_sndSetCameraBrightness (Byte brightness);
haarkon 0:dde1b9d6c9d6 438 int pixy2_sndSetServo (Word s0, Word s1);
haarkon 0:dde1b9d6c9d6 439 int pixy2_sndSetLED (Byte red, Byte green, Byte blue);
haarkon 0:dde1b9d6c9d6 440 int pixy2_sndSetLamp (Byte upper, Byte lower);
haarkon 0:dde1b9d6c9d6 441 int pixy2_sndGetFPS (void);
haarkon 0:dde1b9d6c9d6 442 int pixy2_sndGetBlocks (Byte sigmap, Byte maxBloc);
haarkon 0:dde1b9d6c9d6 443 int pixy2_sndGetMainFeature (Byte type, Byte feature);
haarkon 0:dde1b9d6c9d6 444 int pixy2_sndSetMode (Byte mode);
haarkon 0:dde1b9d6c9d6 445 int pixy2_sndSetNexTurn (Word angle);
haarkon 0:dde1b9d6c9d6 446 int pixy2_sndSetDefaultTurn (Word angle);
haarkon 0:dde1b9d6c9d6 447 int pixy2_sndSetVector (Byte vectorIndex);
haarkon 0:dde1b9d6c9d6 448 int pixy2_sndReverseVector (void);
haarkon 0:dde1b9d6c9d6 449 int pixy2_sndGetRGB (Word x, Word y, Byte saturate);
haarkon 0:dde1b9d6c9d6 450
haarkon 0:dde1b9d6c9d6 451 void pixy2_getByte ();
haarkon 0:dde1b9d6c9d6 452 int pixy2_validateChecksum (Byte* tab);
haarkon 0:dde1b9d6c9d6 453 };
haarkon 0:dde1b9d6c9d6 454
haarkon 0:dde1b9d6c9d6 455 #endif