Transistor Gijutsu, October 2014, Special Features Chapter 8,Software of the thermistor thermometer of 0.001 ° resolution, トランジスタ技術2014年10月号 特集第8章のソフトウェア 0.001℃分解能で気配もキャッチ「超敏感肌温度計」

Dependencies:   USBDevice mbed

Information

tg_201410s8_AD7714 トランジスタ技術 2014年 10月号 第8章のソフトウェア

Program for Section 8 in October. 2014 issue of the Transistor Gijutsu
(Japanese electronics magazine)

概要

このプログラムは、サーミスタの抵抗値変化をAD7714(24bitADC)で測定し、抵抗値を温度値に変換することで、0.001℃程度の分解能で温度変化を測定します。

ファイル

このソフトウエアは、次のファイルから構成されています。

  • AD7714.cpp - AD7714の内部レジスタを設定
  • Thermistor.cpp - サーミスタの抵抗値から温度値に変換
  • ExpAvr.cpp - 指数平均によるソフトウエアLPF
  • main.cpp - main()関数

詳細については、10月号の記事および上記ファイル中のコメントを参照してください。

Committer:
Dance
Date:
Fri Aug 29 08:38:36 2014 +0000
Revision:
0:de885a6da962
Transistor Gijutsu, October 2014, Special Features Chapter 8; ????????2014?10??????8????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Dance 0:de885a6da962 1 /* Copyright (c) 2010-2011 mbed.org, MIT License
Dance 0:de885a6da962 2 *
Dance 0:de885a6da962 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
Dance 0:de885a6da962 4 * and associated documentation files (the "Software"), to deal in the Software without
Dance 0:de885a6da962 5 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
Dance 0:de885a6da962 6 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
Dance 0:de885a6da962 7 * Software is furnished to do so, subject to the following conditions:
Dance 0:de885a6da962 8 *
Dance 0:de885a6da962 9 * The above copyright notice and this permission notice shall be included in all copies or
Dance 0:de885a6da962 10 * substantial portions of the Software.
Dance 0:de885a6da962 11 *
Dance 0:de885a6da962 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
Dance 0:de885a6da962 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
Dance 0:de885a6da962 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
Dance 0:de885a6da962 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
Dance 0:de885a6da962 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
Dance 0:de885a6da962 17 */
Dance 0:de885a6da962 18
Dance 0:de885a6da962 19 #if defined(TARGET_LPC4088)
Dance 0:de885a6da962 20
Dance 0:de885a6da962 21 #include "USBHAL.h"
Dance 0:de885a6da962 22
Dance 0:de885a6da962 23
Dance 0:de885a6da962 24 // Get endpoint direction
Dance 0:de885a6da962 25 #define IN_EP(endpoint) ((endpoint) & 1U ? true : false)
Dance 0:de885a6da962 26 #define OUT_EP(endpoint) ((endpoint) & 1U ? false : true)
Dance 0:de885a6da962 27
Dance 0:de885a6da962 28 // Convert physical endpoint number to register bit
Dance 0:de885a6da962 29 #define EP(endpoint) (1UL<<endpoint)
Dance 0:de885a6da962 30
Dance 0:de885a6da962 31 // Power Control for Peripherals register
Dance 0:de885a6da962 32 #define PCUSB (1UL<<31)
Dance 0:de885a6da962 33
Dance 0:de885a6da962 34 // USB Clock Control register
Dance 0:de885a6da962 35 #define DEV_CLK_EN (1UL<<1)
Dance 0:de885a6da962 36 #define PORT_CLK_EN (1UL<<3)
Dance 0:de885a6da962 37 #define AHB_CLK_EN (1UL<<4)
Dance 0:de885a6da962 38
Dance 0:de885a6da962 39 // USB Clock Status register
Dance 0:de885a6da962 40 #define DEV_CLK_ON (1UL<<1)
Dance 0:de885a6da962 41 #define AHB_CLK_ON (1UL<<4)
Dance 0:de885a6da962 42
Dance 0:de885a6da962 43 // USB Device Interupt registers
Dance 0:de885a6da962 44 #define FRAME (1UL<<0)
Dance 0:de885a6da962 45 #define EP_FAST (1UL<<1)
Dance 0:de885a6da962 46 #define EP_SLOW (1UL<<2)
Dance 0:de885a6da962 47 #define DEV_STAT (1UL<<3)
Dance 0:de885a6da962 48 #define CCEMPTY (1UL<<4)
Dance 0:de885a6da962 49 #define CDFULL (1UL<<5)
Dance 0:de885a6da962 50 #define RxENDPKT (1UL<<6)
Dance 0:de885a6da962 51 #define TxENDPKT (1UL<<7)
Dance 0:de885a6da962 52 #define EP_RLZED (1UL<<8)
Dance 0:de885a6da962 53 #define ERR_INT (1UL<<9)
Dance 0:de885a6da962 54
Dance 0:de885a6da962 55 // USB Control register
Dance 0:de885a6da962 56 #define RD_EN (1<<0)
Dance 0:de885a6da962 57 #define WR_EN (1<<1)
Dance 0:de885a6da962 58 #define LOG_ENDPOINT(endpoint) ((endpoint>>1)<<2)
Dance 0:de885a6da962 59
Dance 0:de885a6da962 60 // USB Receive Packet Length register
Dance 0:de885a6da962 61 #define DV (1UL<<10)
Dance 0:de885a6da962 62 #define PKT_RDY (1UL<<11)
Dance 0:de885a6da962 63 #define PKT_LNGTH_MASK (0x3ff)
Dance 0:de885a6da962 64
Dance 0:de885a6da962 65 // Serial Interface Engine (SIE)
Dance 0:de885a6da962 66 #define SIE_WRITE (0x01)
Dance 0:de885a6da962 67 #define SIE_READ (0x02)
Dance 0:de885a6da962 68 #define SIE_COMMAND (0x05)
Dance 0:de885a6da962 69 #define SIE_CMD_CODE(phase, data) ((phase<<8)|(data<<16))
Dance 0:de885a6da962 70
Dance 0:de885a6da962 71 // SIE Command codes
Dance 0:de885a6da962 72 #define SIE_CMD_SET_ADDRESS (0xD0)
Dance 0:de885a6da962 73 #define SIE_CMD_CONFIGURE_DEVICE (0xD8)
Dance 0:de885a6da962 74 #define SIE_CMD_SET_MODE (0xF3)
Dance 0:de885a6da962 75 #define SIE_CMD_READ_FRAME_NUMBER (0xF5)
Dance 0:de885a6da962 76 #define SIE_CMD_READ_TEST_REGISTER (0xFD)
Dance 0:de885a6da962 77 #define SIE_CMD_SET_DEVICE_STATUS (0xFE)
Dance 0:de885a6da962 78 #define SIE_CMD_GET_DEVICE_STATUS (0xFE)
Dance 0:de885a6da962 79 #define SIE_CMD_GET_ERROR_CODE (0xFF)
Dance 0:de885a6da962 80 #define SIE_CMD_READ_ERROR_STATUS (0xFB)
Dance 0:de885a6da962 81
Dance 0:de885a6da962 82 #define SIE_CMD_SELECT_ENDPOINT(endpoint) (0x00+endpoint)
Dance 0:de885a6da962 83 #define SIE_CMD_SELECT_ENDPOINT_CLEAR_INTERRUPT(endpoint) (0x40+endpoint)
Dance 0:de885a6da962 84 #define SIE_CMD_SET_ENDPOINT_STATUS(endpoint) (0x40+endpoint)
Dance 0:de885a6da962 85
Dance 0:de885a6da962 86 #define SIE_CMD_CLEAR_BUFFER (0xF2)
Dance 0:de885a6da962 87 #define SIE_CMD_VALIDATE_BUFFER (0xFA)
Dance 0:de885a6da962 88
Dance 0:de885a6da962 89 // SIE Device Status register
Dance 0:de885a6da962 90 #define SIE_DS_CON (1<<0)
Dance 0:de885a6da962 91 #define SIE_DS_CON_CH (1<<1)
Dance 0:de885a6da962 92 #define SIE_DS_SUS (1<<2)
Dance 0:de885a6da962 93 #define SIE_DS_SUS_CH (1<<3)
Dance 0:de885a6da962 94 #define SIE_DS_RST (1<<4)
Dance 0:de885a6da962 95
Dance 0:de885a6da962 96 // SIE Device Set Address register
Dance 0:de885a6da962 97 #define SIE_DSA_DEV_EN (1<<7)
Dance 0:de885a6da962 98
Dance 0:de885a6da962 99 // SIE Configue Device register
Dance 0:de885a6da962 100 #define SIE_CONF_DEVICE (1<<0)
Dance 0:de885a6da962 101
Dance 0:de885a6da962 102 // Select Endpoint register
Dance 0:de885a6da962 103 #define SIE_SE_FE (1<<0)
Dance 0:de885a6da962 104 #define SIE_SE_ST (1<<1)
Dance 0:de885a6da962 105 #define SIE_SE_STP (1<<2)
Dance 0:de885a6da962 106 #define SIE_SE_PO (1<<3)
Dance 0:de885a6da962 107 #define SIE_SE_EPN (1<<4)
Dance 0:de885a6da962 108 #define SIE_SE_B_1_FULL (1<<5)
Dance 0:de885a6da962 109 #define SIE_SE_B_2_FULL (1<<6)
Dance 0:de885a6da962 110
Dance 0:de885a6da962 111 // Set Endpoint Status command
Dance 0:de885a6da962 112 #define SIE_SES_ST (1<<0)
Dance 0:de885a6da962 113 #define SIE_SES_DA (1<<5)
Dance 0:de885a6da962 114 #define SIE_SES_RF_MO (1<<6)
Dance 0:de885a6da962 115 #define SIE_SES_CND_ST (1<<7)
Dance 0:de885a6da962 116
Dance 0:de885a6da962 117
Dance 0:de885a6da962 118 USBHAL * USBHAL::instance;
Dance 0:de885a6da962 119
Dance 0:de885a6da962 120 static volatile int epComplete;
Dance 0:de885a6da962 121 static uint32_t endpointStallState;
Dance 0:de885a6da962 122
Dance 0:de885a6da962 123 static void SIECommand(uint32_t command) {
Dance 0:de885a6da962 124 // The command phase of a SIE transaction
Dance 0:de885a6da962 125 LPC_USB->DevIntClr = CCEMPTY;
Dance 0:de885a6da962 126 LPC_USB->CmdCode = SIE_CMD_CODE(SIE_COMMAND, command);
Dance 0:de885a6da962 127 while (!(LPC_USB->DevIntSt & CCEMPTY));
Dance 0:de885a6da962 128 }
Dance 0:de885a6da962 129
Dance 0:de885a6da962 130 static void SIEWriteData(uint8_t data) {
Dance 0:de885a6da962 131 // The data write phase of a SIE transaction
Dance 0:de885a6da962 132 LPC_USB->DevIntClr = CCEMPTY;
Dance 0:de885a6da962 133 LPC_USB->CmdCode = SIE_CMD_CODE(SIE_WRITE, data);
Dance 0:de885a6da962 134 while (!(LPC_USB->DevIntSt & CCEMPTY));
Dance 0:de885a6da962 135 }
Dance 0:de885a6da962 136
Dance 0:de885a6da962 137 static uint8_t SIEReadData(uint32_t command) {
Dance 0:de885a6da962 138 // The data read phase of a SIE transaction
Dance 0:de885a6da962 139 LPC_USB->DevIntClr = CDFULL;
Dance 0:de885a6da962 140 LPC_USB->CmdCode = SIE_CMD_CODE(SIE_READ, command);
Dance 0:de885a6da962 141 while (!(LPC_USB->DevIntSt & CDFULL));
Dance 0:de885a6da962 142 return (uint8_t)LPC_USB->CmdData;
Dance 0:de885a6da962 143 }
Dance 0:de885a6da962 144
Dance 0:de885a6da962 145 static void SIEsetDeviceStatus(uint8_t status) {
Dance 0:de885a6da962 146 // Write SIE device status register
Dance 0:de885a6da962 147 SIECommand(SIE_CMD_SET_DEVICE_STATUS);
Dance 0:de885a6da962 148 SIEWriteData(status);
Dance 0:de885a6da962 149 }
Dance 0:de885a6da962 150
Dance 0:de885a6da962 151 static uint8_t SIEgetDeviceStatus(void) {
Dance 0:de885a6da962 152 // Read SIE device status register
Dance 0:de885a6da962 153 SIECommand(SIE_CMD_GET_DEVICE_STATUS);
Dance 0:de885a6da962 154 return SIEReadData(SIE_CMD_GET_DEVICE_STATUS);
Dance 0:de885a6da962 155 }
Dance 0:de885a6da962 156
Dance 0:de885a6da962 157 void SIEsetAddress(uint8_t address) {
Dance 0:de885a6da962 158 // Write SIE device address register
Dance 0:de885a6da962 159 SIECommand(SIE_CMD_SET_ADDRESS);
Dance 0:de885a6da962 160 SIEWriteData((address & 0x7f) | SIE_DSA_DEV_EN);
Dance 0:de885a6da962 161 }
Dance 0:de885a6da962 162
Dance 0:de885a6da962 163 static uint8_t SIEselectEndpoint(uint8_t endpoint) {
Dance 0:de885a6da962 164 // SIE select endpoint command
Dance 0:de885a6da962 165 SIECommand(SIE_CMD_SELECT_ENDPOINT(endpoint));
Dance 0:de885a6da962 166 return SIEReadData(SIE_CMD_SELECT_ENDPOINT(endpoint));
Dance 0:de885a6da962 167 }
Dance 0:de885a6da962 168
Dance 0:de885a6da962 169 static uint8_t SIEclearBuffer(void) {
Dance 0:de885a6da962 170 // SIE clear buffer command
Dance 0:de885a6da962 171 SIECommand(SIE_CMD_CLEAR_BUFFER);
Dance 0:de885a6da962 172 return SIEReadData(SIE_CMD_CLEAR_BUFFER);
Dance 0:de885a6da962 173 }
Dance 0:de885a6da962 174
Dance 0:de885a6da962 175 static void SIEvalidateBuffer(void) {
Dance 0:de885a6da962 176 // SIE validate buffer command
Dance 0:de885a6da962 177 SIECommand(SIE_CMD_VALIDATE_BUFFER);
Dance 0:de885a6da962 178 }
Dance 0:de885a6da962 179
Dance 0:de885a6da962 180 static void SIEsetEndpointStatus(uint8_t endpoint, uint8_t status) {
Dance 0:de885a6da962 181 // SIE set endpoint status command
Dance 0:de885a6da962 182 SIECommand(SIE_CMD_SET_ENDPOINT_STATUS(endpoint));
Dance 0:de885a6da962 183 SIEWriteData(status);
Dance 0:de885a6da962 184 }
Dance 0:de885a6da962 185
Dance 0:de885a6da962 186 static uint16_t SIEgetFrameNumber(void) __attribute__ ((unused));
Dance 0:de885a6da962 187 static uint16_t SIEgetFrameNumber(void) {
Dance 0:de885a6da962 188 // Read current frame number
Dance 0:de885a6da962 189 uint16_t lowByte;
Dance 0:de885a6da962 190 uint16_t highByte;
Dance 0:de885a6da962 191
Dance 0:de885a6da962 192 SIECommand(SIE_CMD_READ_FRAME_NUMBER);
Dance 0:de885a6da962 193 lowByte = SIEReadData(SIE_CMD_READ_FRAME_NUMBER);
Dance 0:de885a6da962 194 highByte = SIEReadData(SIE_CMD_READ_FRAME_NUMBER);
Dance 0:de885a6da962 195
Dance 0:de885a6da962 196 return (highByte << 8) | lowByte;
Dance 0:de885a6da962 197 }
Dance 0:de885a6da962 198
Dance 0:de885a6da962 199 static void SIEconfigureDevice(void) {
Dance 0:de885a6da962 200 // SIE Configure device command
Dance 0:de885a6da962 201 SIECommand(SIE_CMD_CONFIGURE_DEVICE);
Dance 0:de885a6da962 202 SIEWriteData(SIE_CONF_DEVICE);
Dance 0:de885a6da962 203 }
Dance 0:de885a6da962 204
Dance 0:de885a6da962 205 static void SIEunconfigureDevice(void) {
Dance 0:de885a6da962 206 // SIE Configure device command
Dance 0:de885a6da962 207 SIECommand(SIE_CMD_CONFIGURE_DEVICE);
Dance 0:de885a6da962 208 SIEWriteData(0);
Dance 0:de885a6da962 209 }
Dance 0:de885a6da962 210
Dance 0:de885a6da962 211 static void SIEconnect(void) {
Dance 0:de885a6da962 212 // Connect USB device
Dance 0:de885a6da962 213 uint8_t status = SIEgetDeviceStatus();
Dance 0:de885a6da962 214 SIEsetDeviceStatus(status | SIE_DS_CON);
Dance 0:de885a6da962 215 }
Dance 0:de885a6da962 216
Dance 0:de885a6da962 217
Dance 0:de885a6da962 218 static void SIEdisconnect(void) {
Dance 0:de885a6da962 219 // Disconnect USB device
Dance 0:de885a6da962 220 uint8_t status = SIEgetDeviceStatus();
Dance 0:de885a6da962 221 SIEsetDeviceStatus(status & ~SIE_DS_CON);
Dance 0:de885a6da962 222 }
Dance 0:de885a6da962 223
Dance 0:de885a6da962 224
Dance 0:de885a6da962 225 static uint8_t selectEndpointClearInterrupt(uint8_t endpoint) {
Dance 0:de885a6da962 226 // Implemented using using EP_INT_CLR.
Dance 0:de885a6da962 227 LPC_USB->EpIntClr = EP(endpoint);
Dance 0:de885a6da962 228 while (!(LPC_USB->DevIntSt & CDFULL));
Dance 0:de885a6da962 229 return (uint8_t)LPC_USB->CmdData;
Dance 0:de885a6da962 230 }
Dance 0:de885a6da962 231
Dance 0:de885a6da962 232
Dance 0:de885a6da962 233 static void enableEndpointEvent(uint8_t endpoint) {
Dance 0:de885a6da962 234 // Enable an endpoint interrupt
Dance 0:de885a6da962 235 LPC_USB->EpIntEn |= EP(endpoint);
Dance 0:de885a6da962 236 }
Dance 0:de885a6da962 237
Dance 0:de885a6da962 238 static void disableEndpointEvent(uint8_t endpoint) __attribute__ ((unused));
Dance 0:de885a6da962 239 static void disableEndpointEvent(uint8_t endpoint) {
Dance 0:de885a6da962 240 // Disable an endpoint interrupt
Dance 0:de885a6da962 241 LPC_USB->EpIntEn &= ~EP(endpoint);
Dance 0:de885a6da962 242 }
Dance 0:de885a6da962 243
Dance 0:de885a6da962 244 static volatile uint32_t __attribute__((used)) dummyRead;
Dance 0:de885a6da962 245 uint32_t USBHAL::endpointReadcore(uint8_t endpoint, uint8_t *buffer) {
Dance 0:de885a6da962 246 // Read from an OUT endpoint
Dance 0:de885a6da962 247 uint32_t size;
Dance 0:de885a6da962 248 uint32_t i;
Dance 0:de885a6da962 249 uint32_t data = 0;
Dance 0:de885a6da962 250 uint8_t offset;
Dance 0:de885a6da962 251
Dance 0:de885a6da962 252 LPC_USB->Ctrl = LOG_ENDPOINT(endpoint) | RD_EN;
Dance 0:de885a6da962 253 while (!(LPC_USB->RxPLen & PKT_RDY));
Dance 0:de885a6da962 254
Dance 0:de885a6da962 255 size = LPC_USB->RxPLen & PKT_LNGTH_MASK;
Dance 0:de885a6da962 256
Dance 0:de885a6da962 257 offset = 0;
Dance 0:de885a6da962 258
Dance 0:de885a6da962 259 if (size > 0) {
Dance 0:de885a6da962 260 for (i=0; i<size; i++) {
Dance 0:de885a6da962 261 if (offset==0) {
Dance 0:de885a6da962 262 // Fetch up to four bytes of data as a word
Dance 0:de885a6da962 263 data = LPC_USB->RxData;
Dance 0:de885a6da962 264 }
Dance 0:de885a6da962 265
Dance 0:de885a6da962 266 // extract a byte
Dance 0:de885a6da962 267 *buffer = (data>>offset) & 0xff;
Dance 0:de885a6da962 268 buffer++;
Dance 0:de885a6da962 269
Dance 0:de885a6da962 270 // move on to the next byte
Dance 0:de885a6da962 271 offset = (offset + 8) % 32;
Dance 0:de885a6da962 272 }
Dance 0:de885a6da962 273 } else {
Dance 0:de885a6da962 274 dummyRead = LPC_USB->RxData;
Dance 0:de885a6da962 275 }
Dance 0:de885a6da962 276
Dance 0:de885a6da962 277 LPC_USB->Ctrl = 0;
Dance 0:de885a6da962 278
Dance 0:de885a6da962 279 if ((endpoint >> 1) % 3 || (endpoint >> 1) == 0) {
Dance 0:de885a6da962 280 SIEselectEndpoint(endpoint);
Dance 0:de885a6da962 281 SIEclearBuffer();
Dance 0:de885a6da962 282 }
Dance 0:de885a6da962 283
Dance 0:de885a6da962 284 return size;
Dance 0:de885a6da962 285 }
Dance 0:de885a6da962 286
Dance 0:de885a6da962 287 static void endpointWritecore(uint8_t endpoint, uint8_t *buffer, uint32_t size) {
Dance 0:de885a6da962 288 // Write to an IN endpoint
Dance 0:de885a6da962 289 uint32_t temp, data;
Dance 0:de885a6da962 290 uint8_t offset;
Dance 0:de885a6da962 291
Dance 0:de885a6da962 292 LPC_USB->Ctrl = LOG_ENDPOINT(endpoint) | WR_EN;
Dance 0:de885a6da962 293
Dance 0:de885a6da962 294 LPC_USB->TxPLen = size;
Dance 0:de885a6da962 295 offset = 0;
Dance 0:de885a6da962 296 data = 0;
Dance 0:de885a6da962 297
Dance 0:de885a6da962 298 if (size>0) {
Dance 0:de885a6da962 299 do {
Dance 0:de885a6da962 300 // Fetch next data byte into a word-sized temporary variable
Dance 0:de885a6da962 301 temp = *buffer++;
Dance 0:de885a6da962 302
Dance 0:de885a6da962 303 // Add to current data word
Dance 0:de885a6da962 304 temp = temp << offset;
Dance 0:de885a6da962 305 data = data | temp;
Dance 0:de885a6da962 306
Dance 0:de885a6da962 307 // move on to the next byte
Dance 0:de885a6da962 308 offset = (offset + 8) % 32;
Dance 0:de885a6da962 309 size--;
Dance 0:de885a6da962 310
Dance 0:de885a6da962 311 if ((offset==0) || (size==0)) {
Dance 0:de885a6da962 312 // Write the word to the endpoint
Dance 0:de885a6da962 313 LPC_USB->TxData = data;
Dance 0:de885a6da962 314 data = 0;
Dance 0:de885a6da962 315 }
Dance 0:de885a6da962 316 } while (size>0);
Dance 0:de885a6da962 317 } else {
Dance 0:de885a6da962 318 LPC_USB->TxData = 0;
Dance 0:de885a6da962 319 }
Dance 0:de885a6da962 320
Dance 0:de885a6da962 321 // Clear WR_EN to cover zero length packet case
Dance 0:de885a6da962 322 LPC_USB->Ctrl=0;
Dance 0:de885a6da962 323
Dance 0:de885a6da962 324 SIEselectEndpoint(endpoint);
Dance 0:de885a6da962 325 SIEvalidateBuffer();
Dance 0:de885a6da962 326 }
Dance 0:de885a6da962 327
Dance 0:de885a6da962 328 USBHAL::USBHAL(void) {
Dance 0:de885a6da962 329 // Disable IRQ
Dance 0:de885a6da962 330 NVIC_DisableIRQ(USB_IRQn);
Dance 0:de885a6da962 331
Dance 0:de885a6da962 332 // fill in callback array
Dance 0:de885a6da962 333 epCallback[0] = &USBHAL::EP1_OUT_callback;
Dance 0:de885a6da962 334 epCallback[1] = &USBHAL::EP1_IN_callback;
Dance 0:de885a6da962 335 epCallback[2] = &USBHAL::EP2_OUT_callback;
Dance 0:de885a6da962 336 epCallback[3] = &USBHAL::EP2_IN_callback;
Dance 0:de885a6da962 337 epCallback[4] = &USBHAL::EP3_OUT_callback;
Dance 0:de885a6da962 338 epCallback[5] = &USBHAL::EP3_IN_callback;
Dance 0:de885a6da962 339 epCallback[6] = &USBHAL::EP4_OUT_callback;
Dance 0:de885a6da962 340 epCallback[7] = &USBHAL::EP4_IN_callback;
Dance 0:de885a6da962 341 epCallback[8] = &USBHAL::EP5_OUT_callback;
Dance 0:de885a6da962 342 epCallback[9] = &USBHAL::EP5_IN_callback;
Dance 0:de885a6da962 343 epCallback[10] = &USBHAL::EP6_OUT_callback;
Dance 0:de885a6da962 344 epCallback[11] = &USBHAL::EP6_IN_callback;
Dance 0:de885a6da962 345 epCallback[12] = &USBHAL::EP7_OUT_callback;
Dance 0:de885a6da962 346 epCallback[13] = &USBHAL::EP7_IN_callback;
Dance 0:de885a6da962 347 epCallback[14] = &USBHAL::EP8_OUT_callback;
Dance 0:de885a6da962 348 epCallback[15] = &USBHAL::EP8_IN_callback;
Dance 0:de885a6da962 349 epCallback[16] = &USBHAL::EP9_OUT_callback;
Dance 0:de885a6da962 350 epCallback[17] = &USBHAL::EP9_IN_callback;
Dance 0:de885a6da962 351 epCallback[18] = &USBHAL::EP10_OUT_callback;
Dance 0:de885a6da962 352 epCallback[19] = &USBHAL::EP10_IN_callback;
Dance 0:de885a6da962 353 epCallback[20] = &USBHAL::EP11_OUT_callback;
Dance 0:de885a6da962 354 epCallback[21] = &USBHAL::EP11_IN_callback;
Dance 0:de885a6da962 355 epCallback[22] = &USBHAL::EP12_OUT_callback;
Dance 0:de885a6da962 356 epCallback[23] = &USBHAL::EP12_IN_callback;
Dance 0:de885a6da962 357 epCallback[24] = &USBHAL::EP13_OUT_callback;
Dance 0:de885a6da962 358 epCallback[25] = &USBHAL::EP13_IN_callback;
Dance 0:de885a6da962 359 epCallback[26] = &USBHAL::EP14_OUT_callback;
Dance 0:de885a6da962 360 epCallback[27] = &USBHAL::EP14_IN_callback;
Dance 0:de885a6da962 361 epCallback[28] = &USBHAL::EP15_OUT_callback;
Dance 0:de885a6da962 362 epCallback[29] = &USBHAL::EP15_IN_callback;
Dance 0:de885a6da962 363
Dance 0:de885a6da962 364 // Enable power to USB device controller
Dance 0:de885a6da962 365 LPC_SC->PCONP |= PCUSB;
Dance 0:de885a6da962 366
Dance 0:de885a6da962 367 // Enable USB clocks
Dance 0:de885a6da962 368 LPC_USB->USBClkCtrl |= DEV_CLK_EN | AHB_CLK_EN | PORT_CLK_EN;
Dance 0:de885a6da962 369 while ((LPC_USB->USBClkSt & (DEV_CLK_EN | AHB_CLK_EN | PORT_CLK_EN)) != (DEV_CLK_ON | AHB_CLK_ON | PORT_CLK_EN));
Dance 0:de885a6da962 370
Dance 0:de885a6da962 371 // Select port USB2
Dance 0:de885a6da962 372 LPC_USB->StCtrl |= 3;
Dance 0:de885a6da962 373
Dance 0:de885a6da962 374
Dance 0:de885a6da962 375 // Configure pin P0.31 to be USB2
Dance 0:de885a6da962 376 LPC_IOCON->P0_31 &= ~0x07;
Dance 0:de885a6da962 377 LPC_IOCON->P0_31 |= 0x01;
Dance 0:de885a6da962 378
Dance 0:de885a6da962 379 // Disconnect USB device
Dance 0:de885a6da962 380 SIEdisconnect();
Dance 0:de885a6da962 381
Dance 0:de885a6da962 382 // Configure pin P0.14 to be Connect
Dance 0:de885a6da962 383 LPC_IOCON->P0_14 &= ~0x07;
Dance 0:de885a6da962 384 LPC_IOCON->P0_14 |= 0x03;
Dance 0:de885a6da962 385
Dance 0:de885a6da962 386 // Connect must be low for at least 2.5uS
Dance 0:de885a6da962 387 wait(0.3);
Dance 0:de885a6da962 388
Dance 0:de885a6da962 389 // Set the maximum packet size for the control endpoints
Dance 0:de885a6da962 390 realiseEndpoint(EP0IN, MAX_PACKET_SIZE_EP0, 0);
Dance 0:de885a6da962 391 realiseEndpoint(EP0OUT, MAX_PACKET_SIZE_EP0, 0);
Dance 0:de885a6da962 392
Dance 0:de885a6da962 393 // Attach IRQ
Dance 0:de885a6da962 394 instance = this;
Dance 0:de885a6da962 395 NVIC_SetVector(USB_IRQn, (uint32_t)&_usbisr);
Dance 0:de885a6da962 396
Dance 0:de885a6da962 397 // Enable interrupts for device events and EP0
Dance 0:de885a6da962 398 LPC_USB->DevIntEn = EP_SLOW | DEV_STAT | FRAME;
Dance 0:de885a6da962 399 enableEndpointEvent(EP0IN);
Dance 0:de885a6da962 400 enableEndpointEvent(EP0OUT);
Dance 0:de885a6da962 401 }
Dance 0:de885a6da962 402
Dance 0:de885a6da962 403 USBHAL::~USBHAL(void) {
Dance 0:de885a6da962 404 // Ensure device disconnected
Dance 0:de885a6da962 405 SIEdisconnect();
Dance 0:de885a6da962 406 // Disable USB interrupts
Dance 0:de885a6da962 407 NVIC_DisableIRQ(USB_IRQn);
Dance 0:de885a6da962 408 }
Dance 0:de885a6da962 409
Dance 0:de885a6da962 410 void USBHAL::connect(void) {
Dance 0:de885a6da962 411 NVIC_EnableIRQ(USB_IRQn);
Dance 0:de885a6da962 412 // Connect USB device
Dance 0:de885a6da962 413 SIEconnect();
Dance 0:de885a6da962 414 }
Dance 0:de885a6da962 415
Dance 0:de885a6da962 416 void USBHAL::disconnect(void) {
Dance 0:de885a6da962 417 NVIC_DisableIRQ(USB_IRQn);
Dance 0:de885a6da962 418 // Disconnect USB device
Dance 0:de885a6da962 419 SIEdisconnect();
Dance 0:de885a6da962 420 }
Dance 0:de885a6da962 421
Dance 0:de885a6da962 422 void USBHAL::configureDevice(void) {
Dance 0:de885a6da962 423 SIEconfigureDevice();
Dance 0:de885a6da962 424 }
Dance 0:de885a6da962 425
Dance 0:de885a6da962 426 void USBHAL::unconfigureDevice(void) {
Dance 0:de885a6da962 427 SIEunconfigureDevice();
Dance 0:de885a6da962 428 }
Dance 0:de885a6da962 429
Dance 0:de885a6da962 430 void USBHAL::setAddress(uint8_t address) {
Dance 0:de885a6da962 431 SIEsetAddress(address);
Dance 0:de885a6da962 432 }
Dance 0:de885a6da962 433
Dance 0:de885a6da962 434 void USBHAL::EP0setup(uint8_t *buffer) {
Dance 0:de885a6da962 435 endpointReadcore(EP0OUT, buffer);
Dance 0:de885a6da962 436 }
Dance 0:de885a6da962 437
Dance 0:de885a6da962 438 void USBHAL::EP0read(void) {
Dance 0:de885a6da962 439 // Not required
Dance 0:de885a6da962 440 }
Dance 0:de885a6da962 441
Dance 0:de885a6da962 442 void USBHAL::EP0readStage(void) {
Dance 0:de885a6da962 443 // Not required
Dance 0:de885a6da962 444 }
Dance 0:de885a6da962 445
Dance 0:de885a6da962 446 uint32_t USBHAL::EP0getReadResult(uint8_t *buffer) {
Dance 0:de885a6da962 447 return endpointReadcore(EP0OUT, buffer);
Dance 0:de885a6da962 448 }
Dance 0:de885a6da962 449
Dance 0:de885a6da962 450 void USBHAL::EP0write(uint8_t *buffer, uint32_t size) {
Dance 0:de885a6da962 451 endpointWritecore(EP0IN, buffer, size);
Dance 0:de885a6da962 452 }
Dance 0:de885a6da962 453
Dance 0:de885a6da962 454 void USBHAL::EP0getWriteResult(void) {
Dance 0:de885a6da962 455 // Not required
Dance 0:de885a6da962 456 }
Dance 0:de885a6da962 457
Dance 0:de885a6da962 458 void USBHAL::EP0stall(void) {
Dance 0:de885a6da962 459 // This will stall both control endpoints
Dance 0:de885a6da962 460 stallEndpoint(EP0OUT);
Dance 0:de885a6da962 461 }
Dance 0:de885a6da962 462
Dance 0:de885a6da962 463 EP_STATUS USBHAL::endpointRead(uint8_t endpoint, uint32_t maximumSize) {
Dance 0:de885a6da962 464 return EP_PENDING;
Dance 0:de885a6da962 465 }
Dance 0:de885a6da962 466
Dance 0:de885a6da962 467 EP_STATUS USBHAL::endpointReadResult(uint8_t endpoint, uint8_t * buffer, uint32_t *bytesRead) {
Dance 0:de885a6da962 468
Dance 0:de885a6da962 469 //for isochronous endpoint, we don't wait an interrupt
Dance 0:de885a6da962 470 if ((endpoint >> 1) % 3 || (endpoint >> 1) == 0) {
Dance 0:de885a6da962 471 if (!(epComplete & EP(endpoint)))
Dance 0:de885a6da962 472 return EP_PENDING;
Dance 0:de885a6da962 473 }
Dance 0:de885a6da962 474
Dance 0:de885a6da962 475 *bytesRead = endpointReadcore(endpoint, buffer);
Dance 0:de885a6da962 476 epComplete &= ~EP(endpoint);
Dance 0:de885a6da962 477 return EP_COMPLETED;
Dance 0:de885a6da962 478 }
Dance 0:de885a6da962 479
Dance 0:de885a6da962 480 EP_STATUS USBHAL::endpointWrite(uint8_t endpoint, uint8_t *data, uint32_t size) {
Dance 0:de885a6da962 481 if (getEndpointStallState(endpoint)) {
Dance 0:de885a6da962 482 return EP_STALLED;
Dance 0:de885a6da962 483 }
Dance 0:de885a6da962 484
Dance 0:de885a6da962 485 epComplete &= ~EP(endpoint);
Dance 0:de885a6da962 486
Dance 0:de885a6da962 487 endpointWritecore(endpoint, data, size);
Dance 0:de885a6da962 488 return EP_PENDING;
Dance 0:de885a6da962 489 }
Dance 0:de885a6da962 490
Dance 0:de885a6da962 491 EP_STATUS USBHAL::endpointWriteResult(uint8_t endpoint) {
Dance 0:de885a6da962 492 if (epComplete & EP(endpoint)) {
Dance 0:de885a6da962 493 epComplete &= ~EP(endpoint);
Dance 0:de885a6da962 494 return EP_COMPLETED;
Dance 0:de885a6da962 495 }
Dance 0:de885a6da962 496
Dance 0:de885a6da962 497 return EP_PENDING;
Dance 0:de885a6da962 498 }
Dance 0:de885a6da962 499
Dance 0:de885a6da962 500 bool USBHAL::realiseEndpoint(uint8_t endpoint, uint32_t maxPacket, uint32_t flags) {
Dance 0:de885a6da962 501 // Realise an endpoint
Dance 0:de885a6da962 502 LPC_USB->DevIntClr = EP_RLZED;
Dance 0:de885a6da962 503 LPC_USB->ReEp |= EP(endpoint);
Dance 0:de885a6da962 504 LPC_USB->EpInd = endpoint;
Dance 0:de885a6da962 505 LPC_USB->MaxPSize = maxPacket;
Dance 0:de885a6da962 506
Dance 0:de885a6da962 507 while (!(LPC_USB->DevIntSt & EP_RLZED));
Dance 0:de885a6da962 508 LPC_USB->DevIntClr = EP_RLZED;
Dance 0:de885a6da962 509
Dance 0:de885a6da962 510 // Clear stall state
Dance 0:de885a6da962 511 endpointStallState &= ~EP(endpoint);
Dance 0:de885a6da962 512
Dance 0:de885a6da962 513 enableEndpointEvent(endpoint);
Dance 0:de885a6da962 514 return true;
Dance 0:de885a6da962 515 }
Dance 0:de885a6da962 516
Dance 0:de885a6da962 517 void USBHAL::stallEndpoint(uint8_t endpoint) {
Dance 0:de885a6da962 518 // Stall an endpoint
Dance 0:de885a6da962 519 if ( (endpoint==EP0IN) || (endpoint==EP0OUT) ) {
Dance 0:de885a6da962 520 // Conditionally stall both control endpoints
Dance 0:de885a6da962 521 SIEsetEndpointStatus(EP0OUT, SIE_SES_CND_ST);
Dance 0:de885a6da962 522 } else {
Dance 0:de885a6da962 523 SIEsetEndpointStatus(endpoint, SIE_SES_ST);
Dance 0:de885a6da962 524
Dance 0:de885a6da962 525 // Update stall state
Dance 0:de885a6da962 526 endpointStallState |= EP(endpoint);
Dance 0:de885a6da962 527 }
Dance 0:de885a6da962 528 }
Dance 0:de885a6da962 529
Dance 0:de885a6da962 530 void USBHAL::unstallEndpoint(uint8_t endpoint) {
Dance 0:de885a6da962 531 // Unstall an endpoint. The endpoint will also be reinitialised
Dance 0:de885a6da962 532 SIEsetEndpointStatus(endpoint, 0);
Dance 0:de885a6da962 533
Dance 0:de885a6da962 534 // Update stall state
Dance 0:de885a6da962 535 endpointStallState &= ~EP(endpoint);
Dance 0:de885a6da962 536 }
Dance 0:de885a6da962 537
Dance 0:de885a6da962 538 bool USBHAL::getEndpointStallState(uint8_t endpoint) {
Dance 0:de885a6da962 539 // Returns true if endpoint stalled
Dance 0:de885a6da962 540 return endpointStallState & EP(endpoint);
Dance 0:de885a6da962 541 }
Dance 0:de885a6da962 542
Dance 0:de885a6da962 543 void USBHAL::remoteWakeup(void) {
Dance 0:de885a6da962 544 // Remote wakeup
Dance 0:de885a6da962 545 uint8_t status;
Dance 0:de885a6da962 546
Dance 0:de885a6da962 547 // Enable USB clocks
Dance 0:de885a6da962 548 LPC_USB->USBClkCtrl |= DEV_CLK_EN | AHB_CLK_EN;
Dance 0:de885a6da962 549 while (LPC_USB->USBClkSt != (DEV_CLK_ON | AHB_CLK_ON));
Dance 0:de885a6da962 550
Dance 0:de885a6da962 551 status = SIEgetDeviceStatus();
Dance 0:de885a6da962 552 SIEsetDeviceStatus(status & ~SIE_DS_SUS);
Dance 0:de885a6da962 553 }
Dance 0:de885a6da962 554
Dance 0:de885a6da962 555 void USBHAL::_usbisr(void) {
Dance 0:de885a6da962 556 instance->usbisr();
Dance 0:de885a6da962 557 }
Dance 0:de885a6da962 558
Dance 0:de885a6da962 559
Dance 0:de885a6da962 560 void USBHAL::usbisr(void) {
Dance 0:de885a6da962 561 uint8_t devStat;
Dance 0:de885a6da962 562
Dance 0:de885a6da962 563 if (LPC_USB->DevIntSt & FRAME) {
Dance 0:de885a6da962 564 // Start of frame event
Dance 0:de885a6da962 565 SOF(SIEgetFrameNumber());
Dance 0:de885a6da962 566 // Clear interrupt status flag
Dance 0:de885a6da962 567 LPC_USB->DevIntClr = FRAME;
Dance 0:de885a6da962 568 }
Dance 0:de885a6da962 569
Dance 0:de885a6da962 570 if (LPC_USB->DevIntSt & DEV_STAT) {
Dance 0:de885a6da962 571 // Device Status interrupt
Dance 0:de885a6da962 572 // Must clear the interrupt status flag before reading the device status from the SIE
Dance 0:de885a6da962 573 LPC_USB->DevIntClr = DEV_STAT;
Dance 0:de885a6da962 574
Dance 0:de885a6da962 575 // Read device status from SIE
Dance 0:de885a6da962 576 devStat = SIEgetDeviceStatus();
Dance 0:de885a6da962 577 //printf("devStat: %d\r\n", devStat);
Dance 0:de885a6da962 578
Dance 0:de885a6da962 579 if (devStat & SIE_DS_SUS_CH) {
Dance 0:de885a6da962 580 // Suspend status changed
Dance 0:de885a6da962 581 if((devStat & SIE_DS_SUS) != 0) {
Dance 0:de885a6da962 582 suspendStateChanged(0);
Dance 0:de885a6da962 583 }
Dance 0:de885a6da962 584 }
Dance 0:de885a6da962 585
Dance 0:de885a6da962 586 if (devStat & SIE_DS_RST) {
Dance 0:de885a6da962 587 // Bus reset
Dance 0:de885a6da962 588 if((devStat & SIE_DS_SUS) == 0) {
Dance 0:de885a6da962 589 suspendStateChanged(1);
Dance 0:de885a6da962 590 }
Dance 0:de885a6da962 591 busReset();
Dance 0:de885a6da962 592 }
Dance 0:de885a6da962 593 }
Dance 0:de885a6da962 594
Dance 0:de885a6da962 595 if (LPC_USB->DevIntSt & EP_SLOW) {
Dance 0:de885a6da962 596 // (Slow) Endpoint Interrupt
Dance 0:de885a6da962 597
Dance 0:de885a6da962 598 // Process each endpoint interrupt
Dance 0:de885a6da962 599 if (LPC_USB->EpIntSt & EP(EP0OUT)) {
Dance 0:de885a6da962 600 if (selectEndpointClearInterrupt(EP0OUT) & SIE_SE_STP) {
Dance 0:de885a6da962 601 // this is a setup packet
Dance 0:de885a6da962 602 EP0setupCallback();
Dance 0:de885a6da962 603 } else {
Dance 0:de885a6da962 604 EP0out();
Dance 0:de885a6da962 605 }
Dance 0:de885a6da962 606 LPC_USB->DevIntClr = EP_SLOW;
Dance 0:de885a6da962 607 }
Dance 0:de885a6da962 608
Dance 0:de885a6da962 609 if (LPC_USB->EpIntSt & EP(EP0IN)) {
Dance 0:de885a6da962 610 selectEndpointClearInterrupt(EP0IN);
Dance 0:de885a6da962 611 LPC_USB->DevIntClr = EP_SLOW;
Dance 0:de885a6da962 612 EP0in();
Dance 0:de885a6da962 613 }
Dance 0:de885a6da962 614
Dance 0:de885a6da962 615 for (uint8_t num = 2; num < 16*2; num++) {
Dance 0:de885a6da962 616 if (LPC_USB->EpIntSt & EP(num)) {
Dance 0:de885a6da962 617 selectEndpointClearInterrupt(num);
Dance 0:de885a6da962 618 epComplete |= EP(num);
Dance 0:de885a6da962 619 LPC_USB->DevIntClr = EP_SLOW;
Dance 0:de885a6da962 620 if ((instance->*(epCallback[num - 2]))()) {
Dance 0:de885a6da962 621 epComplete &= ~EP(num);
Dance 0:de885a6da962 622 }
Dance 0:de885a6da962 623 }
Dance 0:de885a6da962 624 }
Dance 0:de885a6da962 625 }
Dance 0:de885a6da962 626 }
Dance 0:de885a6da962 627
Dance 0:de885a6da962 628 #endif