parent
b8268d0636
commit
b27c89cc59
@ -0,0 +1,254 @@ |
||||
/*
|
||||
Controlling Elegoo Robot Smart Car Kit 3.0+ with ASIO and C++ |
||||
"Well, it better not leak anymore... stupid window" - javidx9 |
||||
|
||||
Video: https://youtu.be/nkCP95zLvSQ
|
||||
|
||||
License (OLC-3) |
||||
~~~~~~~~~~~~~~~ |
||||
|
||||
Copyright 2018 - 2020 OneLoneCoder.com |
||||
|
||||
Redistribution and use in source and binary forms, with or without |
||||
modification, are permitted provided that the following conditions |
||||
are met: |
||||
|
||||
1. Redistributions or derivations of source code must retain the above |
||||
copyright notice, this list of conditions and the following disclaimer. |
||||
|
||||
2. Redistributions or derivative works in binary form must reproduce |
||||
the above copyright notice. This list of conditions and the following |
||||
disclaimer must be reproduced in the documentation and/or other |
||||
materials provided with the distribution. |
||||
|
||||
3. Neither the name of the copyright holder nor the names of its |
||||
contributors may be used to endorse or promote products derived |
||||
from this software without specific prior written permission. |
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
||||
"AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
||||
LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR |
||||
A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT |
||||
HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, |
||||
SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
||||
LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
||||
DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
||||
THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
||||
(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
||||
OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||||
|
||||
Links |
||||
~~~~~ |
||||
YouTube: https://www.youtube.com/javidx9
|
||||
https://www.youtube.com/javidx9extra
|
||||
Discord: https://discord.gg/WhwHUMV
|
||||
Twitter: https://www.twitter.com/javidx9
|
||||
Twitch: https://www.twitch.tv/javidx9
|
||||
GitHub: https://www.github.com/onelonecoder
|
||||
Homepage: https://www.onelonecoder.com
|
||||
|
||||
Author |
||||
~~~~~~ |
||||
David Barr, aka javidx9, ©OneLoneCoder 2019, 2020 |
||||
|
||||
*/ |
||||
|
||||
#define OLC_PGE_APPLICATION |
||||
#include "olcPixelGameEngine.h" |
||||
|
||||
#define ASIO_STANDALONE |
||||
#define _WINSOCK_DEPRECATED_NO_WARNINGS |
||||
#include <asio.hpp> |
||||
|
||||
class RobotCar : public olc::PixelGameEngine |
||||
{ |
||||
public: |
||||
RobotCar() |
||||
{
|
||||
sAppName = "Robot Car - Simple Control"; |
||||
} |
||||
|
||||
asio::io_context context; |
||||
std::unique_ptr<asio::serial_port> port; |
||||
char nIncomingByte; |
||||
std::string sIncomingData; |
||||
std::thread thrContext; |
||||
|
||||
struct sButton |
||||
{ |
||||
olc::vi2d vPos; |
||||
olc::vi2d vSize; |
||||
std::string sText; |
||||
|
||||
bool clicked(const olc::vi2d& vMousePos) |
||||
{ |
||||
return vMousePos.x >= vPos.x && |
||||
vMousePos.x < (vPos.x + vSize.x) && |
||||
vMousePos.y >= vPos.y && |
||||
vMousePos.y < (vPos.y + vSize.y); |
||||
} |
||||
|
||||
void draw(olc::PixelGameEngine* pge) |
||||
{ |
||||
pge->FillRect(vPos, vSize, olc::BLUE); |
||||
pge->DrawRect(vPos, vSize, olc::WHITE); |
||||
olc::vi2d vTextSize = pge->GetTextSizeProp(sText); |
||||
pge->DrawStringProp(vPos + (vSize - vTextSize) / 2, sText, olc::WHITE); |
||||
} |
||||
}; |
||||
|
||||
sButton btnForwards; |
||||
sButton btnBackwards; |
||||
sButton btnTurnLeft; |
||||
sButton btnTurnRight; |
||||
|
||||
public: |
||||
bool OnUserCreate() override |
||||
{ |
||||
// Create serial port object...
|
||||
port.reset(new asio::serial_port(context)); |
||||
|
||||
asio::error_code ec; |
||||
port->open("COM4", ec); |
||||
|
||||
if (ec) |
||||
{ |
||||
// Port could not be opened, so abort
|
||||
std::cout << ec.message() << std::endl; |
||||
return false; |
||||
} |
||||
|
||||
// ...it should have opened via creation, but check
|
||||
if (port->is_open()) |
||||
{ |
||||
// Set the BAUD rate
|
||||
port->set_option(asio::serial_port::baud_rate(9600)); |
||||
|
||||
// By default the option arguments configure to 8N1...
|
||||
port->set_option(asio::serial_port_base::character_size()); |
||||
port->set_option(asio::serial_port_base::stop_bits()); |
||||
port->set_option(asio::serial_port_base::parity()); |
||||
|
||||
// ...and flow control off
|
||||
port->set_option(asio::serial_port_base::flow_control()); |
||||
|
||||
AsyncReadFromPort(); |
||||
thrContext = std::thread([&](){ context.run(); }); |
||||
} |
||||
|
||||
// Create Buttons
|
||||
btnForwards.vPos = { 78, 10 }; |
||||
btnForwards.vSize = { 100, 30 }; |
||||
btnForwards.sText = "Forwards"; |
||||
|
||||
btnTurnLeft.vPos = { 10, 60 }; |
||||
btnTurnLeft.vSize = { 100, 30 }; |
||||
btnTurnLeft.sText = "Turn Left"; |
||||
|
||||
btnTurnRight.vPos = { 146, 60 }; |
||||
btnTurnRight.vSize = { 100, 30 }; |
||||
btnTurnRight.sText = "Turn Right"; |
||||
|
||||
btnBackwards.vPos = { 78, 110 }; |
||||
btnBackwards.vSize = { 100, 30 }; |
||||
btnBackwards.sText = "Backwards"; |
||||
|
||||
return true; |
||||
} |
||||
|
||||
bool OnUserDestroy() override |
||||
{ |
||||
if (port) |
||||
{ |
||||
// Abort any ongoing communications
|
||||
port->cancel(); |
||||
|
||||
// Close the port
|
||||
port->close(); |
||||
|
||||
// Don't erase the port...
|
||||
} |
||||
|
||||
// Wait for thread to expire
|
||||
if (thrContext.joinable()) |
||||
{
|
||||
thrContext.join(); |
||||
} |
||||
|
||||
// ...until now, as the context may still need it before it expires
|
||||
port.reset(); |
||||
|
||||
return true; |
||||
} |
||||
|
||||
void AsyncReadFromPort() |
||||
{ |
||||
port->async_read_some(asio::buffer(&nIncomingByte, 1), [this](std::error_code ec, std::size_t length) |
||||
{ |
||||
if (!ec) |
||||
{ |
||||
sIncomingData.append(1, nIncomingByte); |
||||
std::cout << nIncomingByte; |
||||
AsyncReadFromPort(); |
||||
}
|
||||
}); |
||||
} |
||||
|
||||
|
||||
|
||||
|
||||
bool OnUserUpdate(float fElapsedTime) override |
||||
{ |
||||
asio::error_code ec; |
||||
|
||||
// Check input
|
||||
if (GetMouse(0).bPressed) |
||||
{ |
||||
if (btnForwards.clicked(GetMousePos())) |
||||
{ |
||||
port->write_some(asio::buffer("f", 1), ec); |
||||
if (ec) std::cout << "Error Moving Forwards\n"; |
||||
} |
||||
|
||||
if (btnBackwards.clicked(GetMousePos())) |
||||
{ |
||||
port->write_some(asio::buffer("b", 1), ec); |
||||
if (ec) std::cout << "Error Moving Backwards\n"; |
||||
} |
||||
|
||||
if (btnTurnLeft.clicked(GetMousePos())) |
||||
{ |
||||
port->write_some(asio::buffer("l", 1), ec); |
||||
if (ec) std::cout << "Error Turning Left\n"; |
||||
} |
||||
|
||||
if (btnTurnRight.clicked(GetMousePos())) |
||||
{ |
||||
port->write_some(asio::buffer("r", 1), ec); |
||||
if (ec) std::cout << "Error Turning Right\n"; |
||||
}
|
||||
} |
||||
|
||||
if (GetMouse(0).bReleased) |
||||
{ |
||||
port->write_some(asio::buffer("s", 1), ec); |
||||
if (ec) std::cout << "Error Stopping!!\n"; |
||||
} |
||||
|
||||
|
||||
Clear(olc::BLACK); |
||||
btnForwards.draw(this); |
||||
btnTurnLeft.draw(this); |
||||
btnTurnRight.draw(this); |
||||
btnBackwards.draw(this); |
||||
return true; |
||||
} |
||||
}; |
||||
|
||||
int main() |
||||
{ |
||||
RobotCar demo; |
||||
if (demo.Construct(256, 240, 4, 4)) |
||||
demo.Start(); |
||||
return 0; |
||||
} |
Loading…
Reference in new issue