Norimasa Okamoto / Mbed 2 deprecated KL46Z-USBHostGPS_HelloWorld

Simple USBHost GPS Dongle Receiver for FRDM-KL46Z test program

Dependencies:   KL46Z-USBHost mbed SLCD

FRDM-KL46ZをUSBホストにしてUSBタイプのGPSレシーバを読み取るテストプログラムです。
/media/uploads/va009039/frdm-kl46z-usbhost-gps.jpg

USBHostGPS/USBHostGPS.cpp@1:2d8275968aaf, 2014-02-05 (annotated)

Committer:
va009039
Date:
Wed Feb 05 13:40:35 2014 +0000
Revision:
1:2d8275968aaf
add NMEA decode. update KL46Z-USBHost library.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 1:2d8275968aaf 1 #include "USBHostGPS.h"
va009039 1:2d8275968aaf 2
va009039 1:2d8275968aaf 3 USBHostGPS::USBHostGPS(int baud_)
va009039 1:2d8275968aaf 4 {
va009039 1:2d8275968aaf 5 host = USBHost::getHostInst();
va009039 1:2d8275968aaf 6 init();
va009039 1:2d8275968aaf 7 baud = baud_;
va009039 1:2d8275968aaf 8 }
va009039 1:2d8275968aaf 9
va009039 1:2d8275968aaf 10 void USBHostGPS::init() {
va009039 1:2d8275968aaf 11 dev = NULL;
va009039 1:2d8275968aaf 12 bulk_in = NULL;
va009039 1:2d8275968aaf 13 onUpdateRaw = NULL;
va009039 1:2d8275968aaf 14 dev_connected = false;
va009039 1:2d8275968aaf 15 gps_device_found = false;
va009039 1:2d8275968aaf 16 gps_intf = -1;
va009039 1:2d8275968aaf 17 }
va009039 1:2d8275968aaf 18
va009039 1:2d8275968aaf 19 bool USBHostGPS::connected() {
va009039 1:2d8275968aaf 20 return dev_connected;
va009039 1:2d8275968aaf 21 }
va009039 1:2d8275968aaf 22
va009039 1:2d8275968aaf 23 bool USBHostGPS::connect() {
va009039 1:2d8275968aaf 24
va009039 1:2d8275968aaf 25 if (dev_connected) {
va009039 1:2d8275968aaf 26 return true;
va009039 1:2d8275968aaf 27 }
va009039 1:2d8275968aaf 28
va009039 1:2d8275968aaf 29 for (uint8_t i = 0; i < MAX_DEVICE_CONNECTED; i++) {
va009039 1:2d8275968aaf 30 if ((dev = host->getDevice(i)) != NULL) {
va009039 1:2d8275968aaf 31 if(host->enumerate(dev, this)) {
va009039 1:2d8275968aaf 32 break;
va009039 1:2d8275968aaf 33 }
va009039 1:2d8275968aaf 34 if (gps_device_found) {
va009039 1:2d8275968aaf 35 bulk_in = dev->getEndpoint(gps_intf, BULK_ENDPOINT, IN);
va009039 1:2d8275968aaf 36 USB_TEST_ASSERT(bulk_in);
va009039 1:2d8275968aaf 37 // stop bit = 1, parity = none, 8bit
va009039 1:2d8275968aaf 38 uint8_t data[] = {baud&0xff, baud>>8, baud>>16, baud>>24, 0x00, 0x00, 0x08};
va009039 1:2d8275968aaf 39 USB_TYPE rc = host->controlWrite(dev, 0x21, PL2303_SET_LINE_CODING, 0, 0, data, sizeof(data));
va009039 1:2d8275968aaf 40 USB_TEST_ASSERT(rc == USB_TYPE_OK);
va009039 1:2d8275968aaf 41 USB_INFO("New GPS device: VID:%04x PID:%04x [dev: %p - intf: %d]", dev->getVid(), dev->getPid(), dev, gps_intf);
va009039 1:2d8275968aaf 42 bulk_in->attach(this, &USBHostGPS::rxHandler);
va009039 1:2d8275968aaf 43 host->bulkRead(dev, bulk_in, bulk_buf, bulk_in->getSize(), false);
va009039 1:2d8275968aaf 44
va009039 1:2d8275968aaf 45 dev_connected = true;
va009039 1:2d8275968aaf 46 return true;
va009039 1:2d8275968aaf 47 }
va009039 1:2d8275968aaf 48 }
va009039 1:2d8275968aaf 49 }
va009039 1:2d8275968aaf 50 init();
va009039 1:2d8275968aaf 51 return false;
va009039 1:2d8275968aaf 52 }
va009039 1:2d8275968aaf 53
va009039 1:2d8275968aaf 54 void USBHostGPS::rxHandler() {
va009039 1:2d8275968aaf 55 int len = bulk_in->getLengthTransferred();
va009039 1:2d8275968aaf 56 if (onUpdateRaw) {
va009039 1:2d8275968aaf 57 (*onUpdateRaw)((char*)bulk_buf, len);
va009039 1:2d8275968aaf 58 }
va009039 1:2d8275968aaf 59 nmea.inputNMEA((char*)bulk_buf, len);
va009039 1:2d8275968aaf 60
va009039 1:2d8275968aaf 61 if (dev) {
va009039 1:2d8275968aaf 62 host->bulkRead(dev, bulk_in, bulk_buf, bulk_in->getSize(), false);
va009039 1:2d8275968aaf 63 }
va009039 1:2d8275968aaf 64 }
va009039 1:2d8275968aaf 65
va009039 1:2d8275968aaf 66 /*virtual*/ void USBHostGPS::setVidPid(uint16_t vid, uint16_t pid)
va009039 1:2d8275968aaf 67 {
va009039 1:2d8275968aaf 68 USB_DBG("vid:%04x pid:%04x", vid, pid);
va009039 1:2d8275968aaf 69 if (pid == 0x2303) {
va009039 1:2d8275968aaf 70 gps_device_found = true;
va009039 1:2d8275968aaf 71 }
va009039 1:2d8275968aaf 72 }
va009039 1:2d8275968aaf 73
va009039 1:2d8275968aaf 74 /*virtual*/ bool USBHostGPS::parseInterface(uint8_t intf_nb, uint8_t intf_class, uint8_t intf_subclass, uint8_t intf_protocol) //Must return true if the interface should be parsed
va009039 1:2d8275968aaf 75 {
va009039 1:2d8275968aaf 76 USB_DBG("intf: %d class: %02x %02x %02x", intf_nb, intf_class, intf_subclass, intf_protocol);
va009039 1:2d8275968aaf 77 if (gps_device_found) {
va009039 1:2d8275968aaf 78 if (gps_intf == -1) {
va009039 1:2d8275968aaf 79 gps_intf = intf_nb;
va009039 1:2d8275968aaf 80 return true;
va009039 1:2d8275968aaf 81 }
va009039 1:2d8275968aaf 82 }
va009039 1:2d8275968aaf 83 return false;
va009039 1:2d8275968aaf 84 }
va009039 1:2d8275968aaf 85
va009039 1:2d8275968aaf 86 /*virtual*/ bool USBHostGPS::useEndpoint(uint8_t intf_nb, ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir) //Must return true if the endpoint will be used
va009039 1:2d8275968aaf 87 {
va009039 1:2d8275968aaf 88 USB_DBG("intf_nb=%d type=%d dir=%d", intf_nb, type, dir);
va009039 1:2d8275968aaf 89 if (gps_device_found) {
va009039 1:2d8275968aaf 90 if (intf_nb == gps_intf) {
va009039 1:2d8275968aaf 91 if (type == BULK_ENDPOINT && dir == IN) {
va009039 1:2d8275968aaf 92 return true;
va009039 1:2d8275968aaf 93 }
va009039 1:2d8275968aaf 94 }
va009039 1:2d8275968aaf 95 }
va009039 1:2d8275968aaf 96 return false;
va009039 1:2d8275968aaf 97 }
va009039 1:2d8275968aaf 98