105 lines
2.8 KiB
C++
105 lines
2.8 KiB
C++
/*
|
|
|
|
Copyright (c) 2022 Ethan Zonca
|
|
|
|
This file is part of cangaroo.
|
|
|
|
cangaroo is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 2 of the License, or
|
|
(at your option) any later version.
|
|
|
|
cangaroo is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with cangaroo. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
|
|
#include "SLCANDriver.h"
|
|
#include "SLCANInterface.h"
|
|
#include <core/Backend.h>
|
|
|
|
#include <errno.h>
|
|
#include <cstring>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
|
|
//
|
|
#include <QCoreApplication>
|
|
#include <QDebug>
|
|
#include <QtSerialPort/QSerialPort>
|
|
#include <QtSerialPort/QSerialPortInfo>
|
|
|
|
SLCANDriver::SLCANDriver(Backend &backend)
|
|
: CanDriver(backend)
|
|
{
|
|
}
|
|
|
|
SLCANDriver::~SLCANDriver() {
|
|
}
|
|
|
|
bool SLCANDriver::update() {
|
|
|
|
deleteAllInterfaces();
|
|
|
|
int interface_cnt = 0;
|
|
|
|
foreach (const QSerialPortInfo &info, QSerialPortInfo::availablePorts()) {
|
|
fprintf(stderr, "Name : %s \r\n", info.portName().toStdString().c_str());
|
|
fprintf(stderr, " Description : %s \r\n", info.description().toStdString().c_str());
|
|
fprintf(stderr, " Manufacturer: %s \r\n", info.manufacturer().toStdString().c_str());
|
|
|
|
if(info.vendorIdentifier() == 0xad50 && info.productIdentifier() == 0x60C4)
|
|
{
|
|
|
|
perror(" ++ CANable 1.0 or similar ST USB CDC device detected");
|
|
|
|
// Create new slcan interface without FD support
|
|
SLCANInterface *intf = createOrUpdateInterface(interface_cnt, info.portName(), false);
|
|
interface_cnt++;
|
|
}
|
|
else if(info.vendorIdentifier() == 0x16D0 && info.productIdentifier() == 0x117E)
|
|
{
|
|
perror(" ++ CANable 2.0 detected");
|
|
|
|
// Create new slcan interface without FD support
|
|
SLCANInterface *intf = createOrUpdateInterface(interface_cnt, info.portName(), true);
|
|
interface_cnt++;
|
|
}
|
|
else
|
|
{
|
|
perror(" !! This is not a CANable device!");
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
QString SLCANDriver::getName() {
|
|
return "CANable SLCAN";
|
|
}
|
|
|
|
|
|
|
|
SLCANInterface *SLCANDriver::createOrUpdateInterface(int index, QString name, bool fd_support) {
|
|
|
|
foreach (CanInterface *intf, getInterfaces()) {
|
|
SLCANInterface *scif = dynamic_cast<SLCANInterface*>(intf);
|
|
if (scif->getIfIndex() == index) {
|
|
scif->setName(name);
|
|
return scif;
|
|
}
|
|
}
|
|
|
|
|
|
SLCANInterface *scif = new SLCANInterface(this, index, name, fd_support);
|
|
addInterface(scif);
|
|
return scif;
|
|
}
|