SkyTEM BMAG / Mbed 2 deprecated BMAGThrRev

Bmag incl gps rettelse

Dependencies:   mbed WDT MODSERIAL BME280

USBHost/USBHost3GModule/WANDongle.cpp@56:df9052e3808c, 2019-06-20 (annotated)

Committer:
gert_lauritsen
Date:
Thu Jun 20 07:13:18 2019 +0000
Revision:
56:df9052e3808c
change date stamp from gps, reads serialnumb from file.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gert_lauritsen 56:df9052e3808c 1 /* Copyright (c) 2010-2012 mbed.org, MIT License
gert_lauritsen 56:df9052e3808c 2 *
gert_lauritsen 56:df9052e3808c 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
gert_lauritsen 56:df9052e3808c 4 * and associated documentation files (the "Software"), to deal in the Software without
gert_lauritsen 56:df9052e3808c 5 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
gert_lauritsen 56:df9052e3808c 6 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
gert_lauritsen 56:df9052e3808c 7 * Software is furnished to do so, subject to the following conditions:
gert_lauritsen 56:df9052e3808c 8 *
gert_lauritsen 56:df9052e3808c 9 * The above copyright notice and this permission notice shall be included in all copies or
gert_lauritsen 56:df9052e3808c 10 * substantial portions of the Software.
gert_lauritsen 56:df9052e3808c 11 *
gert_lauritsen 56:df9052e3808c 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
gert_lauritsen 56:df9052e3808c 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
gert_lauritsen 56:df9052e3808c 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
gert_lauritsen 56:df9052e3808c 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
gert_lauritsen 56:df9052e3808c 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
gert_lauritsen 56:df9052e3808c 17 */
gert_lauritsen 56:df9052e3808c 18
gert_lauritsen 56:df9052e3808c 19 #include "USBHostConf.h"
gert_lauritsen 56:df9052e3808c 20
gert_lauritsen 56:df9052e3808c 21 #ifdef USBHOST_3GMODULE
gert_lauritsen 56:df9052e3808c 22
gert_lauritsen 56:df9052e3808c 23 #include "dbg.h"
gert_lauritsen 56:df9052e3808c 24 #include <stdint.h>
gert_lauritsen 56:df9052e3808c 25 #include "rtos.h"
gert_lauritsen 56:df9052e3808c 26
gert_lauritsen 56:df9052e3808c 27 #include "WANDongle.h"
gert_lauritsen 56:df9052e3808c 28 #include "WANDongleInitializer.h"
gert_lauritsen 56:df9052e3808c 29
gert_lauritsen 56:df9052e3808c 30 WANDongle::WANDongle() : m_pInitializer(NULL), m_serialCount(0), m_totalInitializers(0)
gert_lauritsen 56:df9052e3808c 31 {
gert_lauritsen 56:df9052e3808c 32 host = USBHost::getHostInst();
gert_lauritsen 56:df9052e3808c 33 init();
gert_lauritsen 56:df9052e3808c 34 }
gert_lauritsen 56:df9052e3808c 35
gert_lauritsen 56:df9052e3808c 36
gert_lauritsen 56:df9052e3808c 37 bool WANDongle::connected() {
gert_lauritsen 56:df9052e3808c 38 return dev_connected;
gert_lauritsen 56:df9052e3808c 39 }
gert_lauritsen 56:df9052e3808c 40
gert_lauritsen 56:df9052e3808c 41 bool WANDongle::tryConnect()
gert_lauritsen 56:df9052e3808c 42 {
gert_lauritsen 56:df9052e3808c 43 //FIXME should run on USB thread
gert_lauritsen 56:df9052e3808c 44
gert_lauritsen 56:df9052e3808c 45 USB_DBG("Trying to connect device");
gert_lauritsen 56:df9052e3808c 46
gert_lauritsen 56:df9052e3808c 47 if (dev_connected) {
gert_lauritsen 56:df9052e3808c 48 USB_DBG("Device is already connected!");
gert_lauritsen 56:df9052e3808c 49 return true;
gert_lauritsen 56:df9052e3808c 50 }
gert_lauritsen 56:df9052e3808c 51
gert_lauritsen 56:df9052e3808c 52 m_pInitializer = NULL;
gert_lauritsen 56:df9052e3808c 53
gert_lauritsen 56:df9052e3808c 54 //Protect from concurrent access from USB thread
gert_lauritsen 56:df9052e3808c 55 USBHost::Lock lock(host);
gert_lauritsen 56:df9052e3808c 56
gert_lauritsen 56:df9052e3808c 57 for (int i = 0; i < MAX_DEVICE_CONNECTED; i++)
gert_lauritsen 56:df9052e3808c 58 {
gert_lauritsen 56:df9052e3808c 59 if ((dev = host->getDevice(i)) != NULL)
gert_lauritsen 56:df9052e3808c 60 {
gert_lauritsen 56:df9052e3808c 61 m_pInitializer = NULL; //Will be set in setVidPid callback
gert_lauritsen 56:df9052e3808c 62
gert_lauritsen 56:df9052e3808c 63 USB_DBG("Enumerate");
gert_lauritsen 56:df9052e3808c 64 int ret = host->enumerate(dev, this);
gert_lauritsen 56:df9052e3808c 65 if(ret)
gert_lauritsen 56:df9052e3808c 66 {
gert_lauritsen 56:df9052e3808c 67 return false;
gert_lauritsen 56:df9052e3808c 68 }
gert_lauritsen 56:df9052e3808c 69
gert_lauritsen 56:df9052e3808c 70 USB_DBG("Device has VID:%04x PID:%04x", dev->getVid(), dev->getPid());
gert_lauritsen 56:df9052e3808c 71
gert_lauritsen 56:df9052e3808c 72 if(m_pInitializer) //If an initializer has been found
gert_lauritsen 56:df9052e3808c 73 {
gert_lauritsen 56:df9052e3808c 74 USB_DBG("m_pInitializer=%p", m_pInitializer);
gert_lauritsen 56:df9052e3808c 75 USB_DBG("m_pInitializer->getSerialVid()=%04x", m_pInitializer->getSerialVid());
gert_lauritsen 56:df9052e3808c 76 USB_DBG("m_pInitializer->getSerialPid()=%04x", m_pInitializer->getSerialPid());
gert_lauritsen 56:df9052e3808c 77 if ((dev->getVid() == m_pInitializer->getSerialVid()) && (dev->getPid() == m_pInitializer->getSerialPid()))
gert_lauritsen 56:df9052e3808c 78 {
gert_lauritsen 56:df9052e3808c 79 USB_DBG("The dongle is in virtual serial mode");
gert_lauritsen 56:df9052e3808c 80 host->registerDriver(dev, 0, this, &WANDongle::init);
gert_lauritsen 56:df9052e3808c 81 m_serialCount = m_pInitializer->getSerialPortCount();
gert_lauritsen 56:df9052e3808c 82 if( m_serialCount > WANDONGLE_MAX_SERIAL_PORTS )
gert_lauritsen 56:df9052e3808c 83 {
gert_lauritsen 56:df9052e3808c 84 m_serialCount = WANDONGLE_MAX_SERIAL_PORTS;
gert_lauritsen 56:df9052e3808c 85 }
gert_lauritsen 56:df9052e3808c 86 for(int j = 0; j < m_serialCount; j++)
gert_lauritsen 56:df9052e3808c 87 {
gert_lauritsen 56:df9052e3808c 88 USB_DBG("Connecting serial port #%d", j+1);
gert_lauritsen 56:df9052e3808c 89 USB_DBG("Ep %p", m_pInitializer->getEp(dev, j, false));
gert_lauritsen 56:df9052e3808c 90 USB_DBG("Ep %p", m_pInitializer->getEp(dev, j, true));
gert_lauritsen 56:df9052e3808c 91 m_serial[j].connect( dev, m_pInitializer->getEp(dev, j, false), m_pInitializer->getEp(dev, j, true) );
gert_lauritsen 56:df9052e3808c 92 }
gert_lauritsen 56:df9052e3808c 93
gert_lauritsen 56:df9052e3808c 94 USB_DBG("Device connected");
gert_lauritsen 56:df9052e3808c 95
gert_lauritsen 56:df9052e3808c 96 dev_connected = true;
gert_lauritsen 56:df9052e3808c 97
gert_lauritsen 56:df9052e3808c 98
gert_lauritsen 56:df9052e3808c 99 return true;
gert_lauritsen 56:df9052e3808c 100 }
gert_lauritsen 56:df9052e3808c 101 else if ((dev->getVid() == m_pInitializer->getMSDVid()) && (dev->getPid() == m_pInitializer->getMSDPid()))
gert_lauritsen 56:df9052e3808c 102 {
gert_lauritsen 56:df9052e3808c 103 USB_DBG("Vodafone K3370 dongle detected in MSD mode");
gert_lauritsen 56:df9052e3808c 104 //Try to switch
gert_lauritsen 56:df9052e3808c 105 if( m_pInitializer->switchMode(dev) )
gert_lauritsen 56:df9052e3808c 106 {
gert_lauritsen 56:df9052e3808c 107 USB_DBG("Switched OK");
gert_lauritsen 56:df9052e3808c 108 return false; //Will be connected on a next iteration
gert_lauritsen 56:df9052e3808c 109 }
gert_lauritsen 56:df9052e3808c 110 else
gert_lauritsen 56:df9052e3808c 111 {
gert_lauritsen 56:df9052e3808c 112 USB_ERR("Could not switch mode");
gert_lauritsen 56:df9052e3808c 113 return false;
gert_lauritsen 56:df9052e3808c 114 }
gert_lauritsen 56:df9052e3808c 115 }
gert_lauritsen 56:df9052e3808c 116 } //if()
gert_lauritsen 56:df9052e3808c 117 } //if()
gert_lauritsen 56:df9052e3808c 118 } //for()
gert_lauritsen 56:df9052e3808c 119 return false;
gert_lauritsen 56:df9052e3808c 120 }
gert_lauritsen 56:df9052e3808c 121
gert_lauritsen 56:df9052e3808c 122 bool WANDongle::disconnect()
gert_lauritsen 56:df9052e3808c 123 {
gert_lauritsen 56:df9052e3808c 124 dev_connected = false;
gert_lauritsen 56:df9052e3808c 125 for(int i = 0; i < WANDONGLE_MAX_SERIAL_PORTS; i++)
gert_lauritsen 56:df9052e3808c 126 {
gert_lauritsen 56:df9052e3808c 127 m_serial[i].disconnect();
gert_lauritsen 56:df9052e3808c 128 }
gert_lauritsen 56:df9052e3808c 129 return true;
gert_lauritsen 56:df9052e3808c 130 }
gert_lauritsen 56:df9052e3808c 131
gert_lauritsen 56:df9052e3808c 132 int WANDongle::getDongleType()
gert_lauritsen 56:df9052e3808c 133 {
gert_lauritsen 56:df9052e3808c 134 if( m_pInitializer != NULL )
gert_lauritsen 56:df9052e3808c 135 {
gert_lauritsen 56:df9052e3808c 136 return m_pInitializer->getType();
gert_lauritsen 56:df9052e3808c 137 }
gert_lauritsen 56:df9052e3808c 138 else
gert_lauritsen 56:df9052e3808c 139 {
gert_lauritsen 56:df9052e3808c 140 return WAN_DONGLE_TYPE_UNKNOWN;
gert_lauritsen 56:df9052e3808c 141 }
gert_lauritsen 56:df9052e3808c 142 }
gert_lauritsen 56:df9052e3808c 143
gert_lauritsen 56:df9052e3808c 144 IUSBHostSerial& WANDongle::getSerial(int index)
gert_lauritsen 56:df9052e3808c 145 {
gert_lauritsen 56:df9052e3808c 146 return m_serial[index];
gert_lauritsen 56:df9052e3808c 147 }
gert_lauritsen 56:df9052e3808c 148
gert_lauritsen 56:df9052e3808c 149 int WANDongle::getSerialCount()
gert_lauritsen 56:df9052e3808c 150 {
gert_lauritsen 56:df9052e3808c 151 return m_serialCount;
gert_lauritsen 56:df9052e3808c 152 }
gert_lauritsen 56:df9052e3808c 153
gert_lauritsen 56:df9052e3808c 154 //Private methods
gert_lauritsen 56:df9052e3808c 155 void WANDongle::init()
gert_lauritsen 56:df9052e3808c 156 {
gert_lauritsen 56:df9052e3808c 157 m_pInitializer = NULL;
gert_lauritsen 56:df9052e3808c 158 dev_connected = false;
gert_lauritsen 56:df9052e3808c 159 for(int i = 0; i < WANDONGLE_MAX_SERIAL_PORTS; i++)
gert_lauritsen 56:df9052e3808c 160 {
gert_lauritsen 56:df9052e3808c 161 m_serial[i].init(host);
gert_lauritsen 56:df9052e3808c 162 }
gert_lauritsen 56:df9052e3808c 163 }
gert_lauritsen 56:df9052e3808c 164
gert_lauritsen 56:df9052e3808c 165
gert_lauritsen 56:df9052e3808c 166 /*virtual*/ void WANDongle::setVidPid(uint16_t vid, uint16_t pid)
gert_lauritsen 56:df9052e3808c 167 {
gert_lauritsen 56:df9052e3808c 168 WANDongleInitializer* initializer;
gert_lauritsen 56:df9052e3808c 169
gert_lauritsen 56:df9052e3808c 170 for(int i = 0; i < m_totalInitializers; i++)
gert_lauritsen 56:df9052e3808c 171 {
gert_lauritsen 56:df9052e3808c 172 initializer = m_Initializers[i];
gert_lauritsen 56:df9052e3808c 173 USB_DBG("initializer=%p", initializer);
gert_lauritsen 56:df9052e3808c 174 USB_DBG("initializer->getSerialVid()=%04x", initializer->getSerialVid());
gert_lauritsen 56:df9052e3808c 175 USB_DBG("initializer->getSerialPid()=%04x", initializer->getSerialPid());
gert_lauritsen 56:df9052e3808c 176 if ((dev->getVid() == initializer->getSerialVid()) && (dev->getPid() == initializer->getSerialPid()))
gert_lauritsen 56:df9052e3808c 177 {
gert_lauritsen 56:df9052e3808c 178 USB_DBG("The dongle is in virtual serial mode");
gert_lauritsen 56:df9052e3808c 179 m_pInitializer = initializer;
gert_lauritsen 56:df9052e3808c 180 break;
gert_lauritsen 56:df9052e3808c 181 }
gert_lauritsen 56:df9052e3808c 182 else if ((dev->getVid() == initializer->getMSDVid()) && (dev->getPid() == initializer->getMSDPid()))
gert_lauritsen 56:df9052e3808c 183 {
gert_lauritsen 56:df9052e3808c 184 USB_DBG("Dongle detected in MSD mode");
gert_lauritsen 56:df9052e3808c 185 m_pInitializer = initializer;
gert_lauritsen 56:df9052e3808c 186 break;
gert_lauritsen 56:df9052e3808c 187 }
gert_lauritsen 56:df9052e3808c 188 initializer++;
gert_lauritsen 56:df9052e3808c 189 } //for
gert_lauritsen 56:df9052e3808c 190 if(m_pInitializer)
gert_lauritsen 56:df9052e3808c 191 {
gert_lauritsen 56:df9052e3808c 192 m_pInitializer->setVidPid(vid, pid);
gert_lauritsen 56:df9052e3808c 193 }
gert_lauritsen 56:df9052e3808c 194 }
gert_lauritsen 56:df9052e3808c 195
gert_lauritsen 56:df9052e3808c 196 /*virtual*/ bool WANDongle::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
gert_lauritsen 56:df9052e3808c 197 {
gert_lauritsen 56:df9052e3808c 198 if(m_pInitializer)
gert_lauritsen 56:df9052e3808c 199 {
gert_lauritsen 56:df9052e3808c 200 return m_pInitializer->parseInterface(intf_nb, intf_class, intf_subclass, intf_protocol);
gert_lauritsen 56:df9052e3808c 201 }
gert_lauritsen 56:df9052e3808c 202 else
gert_lauritsen 56:df9052e3808c 203 {
gert_lauritsen 56:df9052e3808c 204 return false;
gert_lauritsen 56:df9052e3808c 205 }
gert_lauritsen 56:df9052e3808c 206 }
gert_lauritsen 56:df9052e3808c 207
gert_lauritsen 56:df9052e3808c 208 /*virtual*/ bool WANDongle::useEndpoint(uint8_t intf_nb, ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir) //Must return true if the endpoint will be used
gert_lauritsen 56:df9052e3808c 209 {
gert_lauritsen 56:df9052e3808c 210 if(m_pInitializer)
gert_lauritsen 56:df9052e3808c 211 {
gert_lauritsen 56:df9052e3808c 212 return m_pInitializer->useEndpoint(intf_nb, type, dir);
gert_lauritsen 56:df9052e3808c 213 }
gert_lauritsen 56:df9052e3808c 214 else
gert_lauritsen 56:df9052e3808c 215 {
gert_lauritsen 56:df9052e3808c 216 return false;
gert_lauritsen 56:df9052e3808c 217 }
gert_lauritsen 56:df9052e3808c 218 }
gert_lauritsen 56:df9052e3808c 219
gert_lauritsen 56:df9052e3808c 220
gert_lauritsen 56:df9052e3808c 221 bool WANDongle::addInitializer(WANDongleInitializer* pInitializer)
gert_lauritsen 56:df9052e3808c 222 {
gert_lauritsen 56:df9052e3808c 223 if (m_totalInitializers >= WANDONGLE_MAX_INITIALIZERS)
gert_lauritsen 56:df9052e3808c 224 return false;
gert_lauritsen 56:df9052e3808c 225 m_Initializers[m_totalInitializers++] = pInitializer;
gert_lauritsen 56:df9052e3808c 226 return true;
gert_lauritsen 56:df9052e3808c 227 }
gert_lauritsen 56:df9052e3808c 228
gert_lauritsen 56:df9052e3808c 229 WANDongle::~WANDongle()
gert_lauritsen 56:df9052e3808c 230 {
gert_lauritsen 56:df9052e3808c 231 for(int i = 0; i < m_totalInitializers; i++)
gert_lauritsen 56:df9052e3808c 232 delete m_Initializers[i];
gert_lauritsen 56:df9052e3808c 233 }
gert_lauritsen 56:df9052e3808c 234
gert_lauritsen 56:df9052e3808c 235 #endif /* USBHOST_3GMODULE */