Norimasa Okamoto / Mbed 2 deprecated F401RE-USBHostC270_example

Simple USBHost WebCam test program

Dependencies:   F401RE-USBHost mbed

Fork of KL46Z-USBHostC270_example by Norimasa Okamoto

WebカメラからJPEG画像を読み取るテストプログラムです。
使い方はKL46Z-USBHostC270_exampleと同じです。
動作確認カメラ： Logitech C270, Logitech C210, Logitech Q200R(Qcam Orbit AF), LifeCam VX-500
/media/uploads/va009039/f401re-c270-1.jpg /media/uploads/va009039/k64f-c270.jpg

KL46Z_USBHostC270/decodeMJPEG.cpp@1:22304b8f8395, 2014-01-28 (annotated)

Committer:
va009039
Date:
Tue Jan 28 06:54:16 2014 +0000
Revision:
1:22304b8f8395
Parent:
KL46Z-USBHostC270/decodeMJPEG.cpp@0:a72d9b047d8d 
support Logitech C210 Q200R, LifeCam VX-700(VX-500), Sonix Camera.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 0:a72d9b047d8d 1 // decodeMJPEG.cpp 2012/12/8
va009039 0:a72d9b047d8d 2 // decode motion-jpeg to jpeg
va009039 0:a72d9b047d8d 3 #include "mbed.h"
va009039 0:a72d9b047d8d 4 #include "decodeMJPEG.h"
va009039 0:a72d9b047d8d 5
va009039 0:a72d9b047d8d 6 #define MARK_SOF0 0xc0
va009039 0:a72d9b047d8d 7 #define MARK_DHT 0xc4
va009039 0:a72d9b047d8d 8 #define MARK_RST0 0xd0
va009039 0:a72d9b047d8d 9 #define MARK_RST7 0xd7
va009039 0:a72d9b047d8d 10 #define MARK_SOI 0xd8
va009039 0:a72d9b047d8d 11 #define MARK_EOI 0xd9
va009039 0:a72d9b047d8d 12 #define MARK_SOS 0xda
va009039 0:a72d9b047d8d 13 #define MARK_DQT 0xdb
va009039 0:a72d9b047d8d 14 #define MARK_DRI 0xdd
va009039 0:a72d9b047d8d 15 #define MARK_APP 0xe0
va009039 0:a72d9b047d8d 16
va009039 0:a72d9b047d8d 17 #define SEQ_INIT 0
va009039 0:a72d9b047d8d 18 #define SEQ_SOI 1
va009039 0:a72d9b047d8d 19 #define SEQ_FRAME 2
va009039 0:a72d9b047d8d 20 #define SEQ_MARK 3
va009039 0:a72d9b047d8d 21 #define SEQ_SEG_LEN 4
va009039 0:a72d9b047d8d 22 #define SEQ_SEG_LEN2 5
va009039 0:a72d9b047d8d 23 #define SEQ_SEG_BODY 6
va009039 0:a72d9b047d8d 24 #define SEQ_SOS 7
va009039 0:a72d9b047d8d 25 #define SEQ_SOS2 8
va009039 0:a72d9b047d8d 26
va009039 0:a72d9b047d8d 27 static const uint8_t dht[] = {
va009039 0:a72d9b047d8d 28 0xFF,0xC4,0x01,0xA2,0x00,0x00,0x01,0x05,0x01,0x01,0x01,0x01,0x01,0x01,0x00,0x00,
va009039 0:a72d9b047d8d 29 0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0A,
va009039 0:a72d9b047d8d 30 0x0B,0x01,0x00,0x03,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x00,0x00,0x00,
va009039 0:a72d9b047d8d 31 0x00,0x00,0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0A,0x0B,0x10,0x00,
va009039 0:a72d9b047d8d 32 0x02,0x01,0x03,0x03,0x02,0x04,0x03,0x05,0x05,0x04,0x04,0x00,0x00,0x01,0x7D,0x01,
va009039 0:a72d9b047d8d 33 0x02,0x03,0x00,0x04,0x11,0x05,0x12,0x21,0x31,0x41,0x06,0x13,0x51,0x61,0x07,0x22,
va009039 0:a72d9b047d8d 34 0x71,0x14,0x32,0x81,0x91,0xA1,0x08,0x23,0x42,0xB1,0xC1,0x15,0x52,0xD1,0xF0,0x24,
va009039 0:a72d9b047d8d 35 0x33,0x62,0x72,0x82,0x09,0x0A,0x16,0x17,0x18,0x19,0x1A,0x25,0x26,0x27,0x28,0x29,
va009039 0:a72d9b047d8d 36 0x2A,0x34,0x35,0x36,0x37,0x38,0x39,0x3A,0x43,0x44,0x45,0x46,0x47,0x48,0x49,0x4A,
va009039 0:a72d9b047d8d 37 0x53,0x54,0x55,0x56,0x57,0x58,0x59,0x5A,0x63,0x64,0x65,0x66,0x67,0x68,0x69,0x6A,
va009039 0:a72d9b047d8d 38 0x73,0x74,0x75,0x76,0x77,0x78,0x79,0x7A,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,
va009039 0:a72d9b047d8d 39 0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0xA2,0xA3,0xA4,0xA5,0xA6,0xA7,0xA8,
va009039 0:a72d9b047d8d 40 0xA9,0xAA,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xC2,0xC3,0xC4,0xC5,0xC6,
va009039 0:a72d9b047d8d 41 0xC7,0xC8,0xC9,0xCA,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xE1,0xE2,0xE3,
va009039 0:a72d9b047d8d 42 0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,
va009039 0:a72d9b047d8d 43 0xFA,0x11,0x00,0x02,0x01,0x02,0x04,0x04,0x03,0x04,0x07,0x05,0x04,0x04,0x00,0x01,
va009039 0:a72d9b047d8d 44 0x02,0x77,0x00,0x01,0x02,0x03,0x11,0x04,0x05,0x21,0x31,0x06,0x12,0x41,0x51,0x07,
va009039 0:a72d9b047d8d 45 0x61,0x71,0x13,0x22,0x32,0x81,0x08,0x14,0x42,0x91,0xA1,0xB1,0xC1,0x09,0x23,0x33,
va009039 0:a72d9b047d8d 46 0x52,0xF0,0x15,0x62,0x72,0xD1,0x0A,0x16,0x24,0x34,0xE1,0x25,0xF1,0x17,0x18,0x19,
va009039 0:a72d9b047d8d 47 0x1A,0x26,0x27,0x28,0x29,0x2A,0x35,0x36,0x37,0x38,0x39,0x3A,0x43,0x44,0x45,0x46,
va009039 0:a72d9b047d8d 48 0x47,0x48,0x49,0x4A,0x53,0x54,0x55,0x56,0x57,0x58,0x59,0x5A,0x63,0x64,0x65,0x66,
va009039 0:a72d9b047d8d 49 0x67,0x68,0x69,0x6A,0x73,0x74,0x75,0x76,0x77,0x78,0x79,0x7A,0x82,0x83,0x84,0x85,
va009039 0:a72d9b047d8d 50 0x86,0x87,0x88,0x89,0x8A,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0xA2,0xA3,
va009039 0:a72d9b047d8d 51 0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,
va009039 0:a72d9b047d8d 52 0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,
va009039 0:a72d9b047d8d 53 0xD9,0xDA,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xF2,0xF3,0xF4,0xF5,0xF6,
va009039 0:a72d9b047d8d 54 0xF7,0xF8,0xF9,0xFA,
va009039 0:a72d9b047d8d 55 };
va009039 0:a72d9b047d8d 56
va009039 0:a72d9b047d8d 57 decodeMJPEG::decodeMJPEG()
va009039 0:a72d9b047d8d 58 {
va009039 0:a72d9b047d8d 59 m_seq = SEQ_INIT;
va009039 0:a72d9b047d8d 60 }
va009039 0:a72d9b047d8d 61
va009039 0:a72d9b047d8d 62 void decodeMJPEG::inputPacket(const uint8_t* buf, int len)
va009039 0:a72d9b047d8d 63 {
va009039 0:a72d9b047d8d 64 for(int i = 12; i < len; i++) {
va009039 0:a72d9b047d8d 65 input(buf[i]);
va009039 0:a72d9b047d8d 66 }
va009039 0:a72d9b047d8d 67 }
va009039 0:a72d9b047d8d 68
va009039 0:a72d9b047d8d 69 void decodeMJPEG::input(uint8_t c)
va009039 0:a72d9b047d8d 70 {
va009039 0:a72d9b047d8d 71 switch(m_seq) {
va009039 0:a72d9b047d8d 72 case SEQ_INIT:
va009039 0:a72d9b047d8d 73 if (c == 0xff) {
va009039 0:a72d9b047d8d 74 m_seq = SEQ_SOI;
va009039 0:a72d9b047d8d 75 }
va009039 0:a72d9b047d8d 76 break;
va009039 0:a72d9b047d8d 77 case SEQ_SOI:
va009039 0:a72d9b047d8d 78 if (c == MARK_SOI) {
va009039 0:a72d9b047d8d 79 outputJPEG(0xff, JPEG_START); // start
va009039 0:a72d9b047d8d 80 outputJPEG(c);
va009039 0:a72d9b047d8d 81 m_bDHT = false;
va009039 0:a72d9b047d8d 82 m_seq = SEQ_FRAME;
va009039 0:a72d9b047d8d 83 } else {
va009039 0:a72d9b047d8d 84 m_seq = SEQ_INIT;
va009039 0:a72d9b047d8d 85 }
va009039 0:a72d9b047d8d 86 break;
va009039 0:a72d9b047d8d 87 case SEQ_FRAME:
va009039 0:a72d9b047d8d 88 if (c == 0xff) {
va009039 0:a72d9b047d8d 89 m_seq = SEQ_MARK;
va009039 0:a72d9b047d8d 90 } else {
va009039 0:a72d9b047d8d 91 m_seq = SEQ_INIT;
va009039 0:a72d9b047d8d 92 }
va009039 0:a72d9b047d8d 93 break;
va009039 0:a72d9b047d8d 94 case SEQ_MARK:
va009039 0:a72d9b047d8d 95 if (c == MARK_SOI || c == MARK_EOI || c == 0x00) {
va009039 0:a72d9b047d8d 96 m_seq = SEQ_INIT;
va009039 0:a72d9b047d8d 97 break;
va009039 0:a72d9b047d8d 98 }
va009039 0:a72d9b047d8d 99 m_mark = c;
va009039 0:a72d9b047d8d 100 m_seq = SEQ_SEG_LEN;
va009039 0:a72d9b047d8d 101 break;
va009039 0:a72d9b047d8d 102 case SEQ_SEG_LEN:
va009039 0:a72d9b047d8d 103 m_seg_len = c;
va009039 0:a72d9b047d8d 104 m_seq = SEQ_SEG_LEN2;
va009039 0:a72d9b047d8d 105 break;
va009039 0:a72d9b047d8d 106 case SEQ_SEG_LEN2:
va009039 0:a72d9b047d8d 107 m_seg_len <<= 8;
va009039 0:a72d9b047d8d 108 m_seg_len |= c;
va009039 0:a72d9b047d8d 109 m_seg_len -= 2;
va009039 0:a72d9b047d8d 110 m_seg_pos = 0;
va009039 0:a72d9b047d8d 111 m_seq = SEQ_SEG_BODY;
va009039 0:a72d9b047d8d 112 if (m_mark == MARK_SOS) {
va009039 0:a72d9b047d8d 113 if (m_bDHT == false) {
va009039 0:a72d9b047d8d 114 for(int i = 0; i < sizeof(dht); i++) {
va009039 0:a72d9b047d8d 115 outputJPEG(dht[i]);
va009039 0:a72d9b047d8d 116 }
va009039 0:a72d9b047d8d 117 }
va009039 0:a72d9b047d8d 118 m_output_desable = false;
va009039 0:a72d9b047d8d 119 } else if (m_mark == MARK_DHT) {
va009039 0:a72d9b047d8d 120 m_bDHT = true;
va009039 0:a72d9b047d8d 121 m_output_desable = false;
va009039 0:a72d9b047d8d 122 } else {
va009039 0:a72d9b047d8d 123 m_output_desable = false;
va009039 0:a72d9b047d8d 124 }
va009039 0:a72d9b047d8d 125 if (!m_output_desable) {
va009039 0:a72d9b047d8d 126 outputJPEG(0xff);
va009039 0:a72d9b047d8d 127 outputJPEG(m_mark);
va009039 0:a72d9b047d8d 128 outputJPEG((m_seg_len+2) >> 8);
va009039 0:a72d9b047d8d 129 outputJPEG((m_seg_len+2) & 0xff);
va009039 0:a72d9b047d8d 130 }
va009039 0:a72d9b047d8d 131 break;
va009039 0:a72d9b047d8d 132 case SEQ_SEG_BODY:
va009039 0:a72d9b047d8d 133 if (!m_output_desable) {
va009039 0:a72d9b047d8d 134 outputJPEG(c);
va009039 0:a72d9b047d8d 135 }
va009039 0:a72d9b047d8d 136 if (++m_seg_pos < m_seg_len) {
va009039 0:a72d9b047d8d 137 break;
va009039 0:a72d9b047d8d 138 }
va009039 0:a72d9b047d8d 139 if (m_mark == MARK_SOS) {
va009039 0:a72d9b047d8d 140 m_seq = SEQ_SOS;
va009039 0:a72d9b047d8d 141 break;
va009039 0:a72d9b047d8d 142 }
va009039 0:a72d9b047d8d 143 m_seq = SEQ_FRAME;
va009039 0:a72d9b047d8d 144 break;
va009039 0:a72d9b047d8d 145 case SEQ_SOS:
va009039 0:a72d9b047d8d 146 if (c == 0xff) {
va009039 0:a72d9b047d8d 147 m_seq = SEQ_SOS2;
va009039 0:a72d9b047d8d 148 break;
va009039 0:a72d9b047d8d 149 }
va009039 0:a72d9b047d8d 150 outputJPEG(c);
va009039 0:a72d9b047d8d 151 break;
va009039 0:a72d9b047d8d 152 case SEQ_SOS2:
va009039 0:a72d9b047d8d 153 if (c == 0x00) {
va009039 0:a72d9b047d8d 154 outputJPEG(0xff);
va009039 0:a72d9b047d8d 155 outputJPEG(0x00);
va009039 0:a72d9b047d8d 156 m_seq = SEQ_SOS;
va009039 0:a72d9b047d8d 157 break;
va009039 0:a72d9b047d8d 158 } else if (c >= MARK_RST0 && c <= MARK_RST7) {
va009039 0:a72d9b047d8d 159 outputJPEG(0xff);
va009039 0:a72d9b047d8d 160 outputJPEG(c);
va009039 0:a72d9b047d8d 161 m_seq = SEQ_SOS;
va009039 0:a72d9b047d8d 162 break;
va009039 0:a72d9b047d8d 163 } else if (c == MARK_EOI) {
va009039 0:a72d9b047d8d 164 outputJPEG(0xff);
va009039 0:a72d9b047d8d 165 outputJPEG(c, JPEG_END);
va009039 0:a72d9b047d8d 166 m_seq = SEQ_INIT;
va009039 0:a72d9b047d8d 167 break;
va009039 0:a72d9b047d8d 168 } else if (c == MARK_SOI) {
va009039 0:a72d9b047d8d 169 outputJPEG(0xff);
va009039 0:a72d9b047d8d 170 outputJPEG(c);
va009039 0:a72d9b047d8d 171 m_seq = SEQ_INIT;
va009039 0:a72d9b047d8d 172 break;
va009039 0:a72d9b047d8d 173 }
va009039 0:a72d9b047d8d 174 m_seq = SEQ_INIT;
va009039 0:a72d9b047d8d 175 break;
va009039 0:a72d9b047d8d 176 default:
va009039 0:a72d9b047d8d 177 m_seq = SEQ_INIT;
va009039 0:a72d9b047d8d 178 break;
va009039 0:a72d9b047d8d 179 }
va009039 0:a72d9b047d8d 180 }