Added Robot Arm #1
Javidx9
6 years ago
committed by
GitHub
parent
04af4f42da
commit
c695aa16f7
@ -0,0 +1,272 @@ |
|||||||
|
/*
|
||||||
|
Programming a robotic arm |
||||||
|
"I told you, put down the screwdriver..." - javidx9 |
||||||
|
|
||||||
|
License (OLC-3) |
||||||
|
~~~~~~~~~~~~~~~ |
||||||
|
|
||||||
|
Copyright 2018-2019 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. |
||||||
|
|
||||||
|
Instructions: |
||||||
|
~~~~~~~~~~~~~ |
||||||
|
Without a robot arm and an mbed there is not much you can do! |
||||||
|
Also requires a 3rd Party PGEX UI by ZleapingBear: |
||||||
|
https://youtu.be/bfiSjC__MCI
|
||||||
|
|
||||||
|
|
||||||
|
Relevant Video: https://youtu.be/ekdQ-aAB36Y
|
||||||
|
|
||||||
|
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
|
||||||
|
Patreon: https://www.patreon.com/javidx9
|
||||||
|
Homepage: https://www.onelonecoder.com
|
||||||
|
|
||||||
|
Author |
||||||
|
~~~~~~ |
||||||
|
David Barr, aka javidx9, ©OneLoneCoder 2019 |
||||||
|
*/ |
||||||
|
|
||||||
|
#define OLC_PGE_APPLICATION |
||||||
|
#include "olcPixelGameEngine.h" |
||||||
|
#include "olcPGEX_UI.h" |
||||||
|
|
||||||
|
class RobotArm1 : public olc::PixelGameEngine |
||||||
|
{ |
||||||
|
public: |
||||||
|
RobotArm1() |
||||||
|
{ |
||||||
|
sAppName = "Robot Arm 1"; |
||||||
|
} |
||||||
|
|
||||||
|
olc::UI_CONTAINER gui; |
||||||
|
float fJointAngle[6]; |
||||||
|
float fAccumulatedTime = 0.0f; |
||||||
|
HANDLE hCom = nullptr; |
||||||
|
|
||||||
|
|
||||||
|
public: |
||||||
|
bool OnUserCreate() override |
||||||
|
{ |
||||||
|
gui.addSlider(10, 20, 180); |
||||||
|
gui.addSlider(10, 60, 180); |
||||||
|
gui.addSlider(10, 100, 180); |
||||||
|
gui.addSlider(10, 140, 180); |
||||||
|
gui.addSlider(10, 180, 180); |
||||||
|
gui.addSlider(10, 220, 180); |
||||||
|
gui.setValue(0, 50); |
||||||
|
gui.setValue(1, 50); |
||||||
|
gui.setValue(2, 50); |
||||||
|
gui.setValue(3, 50); |
||||||
|
gui.setValue(4, 50); |
||||||
|
gui.setValue(5, 50); |
||||||
|
|
||||||
|
// Open COM Port
|
||||||
|
hCom = CreateFile("COM3", GENERIC_READ | GENERIC_WRITE, 0, nullptr, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, nullptr); |
||||||
|
if (hCom == nullptr) return false; |
||||||
|
|
||||||
|
// Configure Protocol: 9600bps, 8N1
|
||||||
|
DCB dcb = { 0 }; |
||||||
|
GetCommState(hCom, &dcb); |
||||||
|
dcb.BaudRate = CBR_9600; |
||||||
|
dcb.ByteSize = 8; |
||||||
|
dcb.StopBits = ONESTOPBIT; |
||||||
|
dcb.Parity = NOPARITY; |
||||||
|
SetCommState(hCom, &dcb);
|
||||||
|
return true; |
||||||
|
} |
||||||
|
|
||||||
|
bool OnUserDestroy() override |
||||||
|
{ |
||||||
|
if (hCom != nullptr) CloseHandle(hCom); |
||||||
|
|
||||||
|
return true; |
||||||
|
} |
||||||
|
|
||||||
|
bool OnUserUpdate(float fElapsedTime) override |
||||||
|
{ |
||||||
|
gui.Update(fElapsedTime); |
||||||
|
Clear(olc::GREEN); |
||||||
|
gui.drawUIObjects(); |
||||||
|
|
||||||
|
for (int i = 0; i < 6; i++) |
||||||
|
fJointAngle[i] = (gui.getSliderFloat(i) / 100.0f) * 180.0f - 90.0f; |
||||||
|
|
||||||
|
unsigned char command[12]; |
||||||
|
for (int i = 0; i < 6; i++) |
||||||
|
{ |
||||||
|
command[i * 2 + 0] = i; |
||||||
|
command[i * 2 + 1] = (int)(128 + fJointAngle[i]); |
||||||
|
} |
||||||
|
|
||||||
|
fAccumulatedTime += fElapsedTime; |
||||||
|
if (fAccumulatedTime > 0.05f) |
||||||
|
{ |
||||||
|
fAccumulatedTime -= 0.05f; |
||||||
|
DWORD bw = 0; |
||||||
|
WriteFile(hCom, command, 12, &bw, 0); |
||||||
|
} |
||||||
|
|
||||||
|
return true; |
||||||
|
} |
||||||
|
}; |
||||||
|
|
||||||
|
int main() |
||||||
|
{ |
||||||
|
RobotArm1 demo; |
||||||
|
if (demo.Construct(400, 400, 2, 2)) |
||||||
|
demo.Start(); |
||||||
|
return 0; |
||||||
|
} |
||||||
|
|
||||||
|
// Below here is the source code compiled on MBED LPC1768, using the BufferedSerial Library
|
||||||
|
|
||||||
|
/*
|
||||||
|
|
||||||
|
#include "mbed.h" |
||||||
|
#include "BufferedSerial.h" |
||||||
|
|
||||||
|
PwmOut pin26(p26); |
||||||
|
PwmOut pin25(p25); |
||||||
|
PwmOut pin24(p24); |
||||||
|
PwmOut pin23(p23); |
||||||
|
PwmOut pin22(p22); |
||||||
|
PwmOut pin21(p21); |
||||||
|
|
||||||
|
BufferedSerial uart(p9, p10); |
||||||
|
|
||||||
|
|
||||||
|
class Joint |
||||||
|
{ |
||||||
|
private: |
||||||
|
static const float fDutyMin = 0.03f; // -90
|
||||||
|
static const float fDutyMax = 0.11f; // +90
|
||||||
|
static const float fDutyRange = fDutyMax - fDutyMin; |
||||||
|
|
||||||
|
float fTarget; |
||||||
|
float fPosition; |
||||||
|
float fJointMax; |
||||||
|
float fJointMin; |
||||||
|
|
||||||
|
public:
|
||||||
|
Joint(float fMin = -90.0f, float fMax = 90.0f, float fDefaultPos = 0.0f) |
||||||
|
{ |
||||||
|
fJointMin = fMin; |
||||||
|
fJointMax = fMax; |
||||||
|
fPosition = 0.0f; |
||||||
|
SetTarget(fDefaultPos); |
||||||
|
} |
||||||
|
|
||||||
|
void SetTarget(float fAngle) |
||||||
|
{ |
||||||
|
fTarget = fAngle; |
||||||
|
if(fTarget < fJointMin) fTarget = fJointMin; |
||||||
|
if(fTarget > fJointMax) fTarget = fJointMax; |
||||||
|
} |
||||||
|
|
||||||
|
void UpdatePosition() |
||||||
|
{ |
||||||
|
fPosition = fTarget; |
||||||
|
} |
||||||
|
|
||||||
|
float GetTarget() |
||||||
|
{ |
||||||
|
return fTarget; |
||||||
|
} |
||||||
|
|
||||||
|
float GetDutyCycle() |
||||||
|
{ |
||||||
|
float fDutyCycle = fPosition / (fJointMax - fJointMin); |
||||||
|
fDutyCycle = (fDutyCycle * fDutyRange) + fDutyMin + (fDutyRange * 0.5f); |
||||||
|
return fDutyCycle; |
||||||
|
} |
||||||
|
}; |
||||||
|
|
||||||
|
|
||||||
|
int main()
|
||||||
|
{ |
||||||
|
// Servos (MG996R) operate on 20ms period, so set
|
||||||
|
// PWM period for each pin
|
||||||
|
pin26.period(0.02f); |
||||||
|
pin25.period(0.02f); |
||||||
|
pin24.period(0.02f); |
||||||
|
pin23.period(0.02f); |
||||||
|
pin22.period(0.02f); |
||||||
|
pin21.period(0.02f); |
||||||
|
|
||||||
|
Joint joint[6]; |
||||||
|
|
||||||
|
joint[0].SetTarget(0.0f); |
||||||
|
joint[1].SetTarget(0.0f); |
||||||
|
joint[2].SetTarget(0.0f); |
||||||
|
joint[3].SetTarget(-25.0f); |
||||||
|
joint[4].SetTarget(-20.0f); |
||||||
|
joint[5].SetTarget(-15.0f); |
||||||
|
|
||||||
|
int nTargetJoint = 0; |
||||||
|
|
||||||
|
while(1) |
||||||
|
{ |
||||||
|
// Read from UART
|
||||||
|
if(uart.readable()) |
||||||
|
{ |
||||||
|
unsigned char c = (unsigned char)uart.getc(); |
||||||
|
|
||||||
|
if(c < 10) |
||||||
|
nTargetJoint = c; |
||||||
|
else |
||||||
|
joint[nTargetJoint].SetTarget((float)c - 128);
|
||||||
|
|
||||||
|
} |
||||||
|
|
||||||
|
|
||||||
|
// Write Duty Cycles
|
||||||
|
// Update each joints position
|
||||||
|
for(int i=0; i<6; i++) |
||||||
|
joint[i].UpdatePosition(); |
||||||
|
|
||||||
|
// Set PWM values for each joint
|
||||||
|
pin26.write(joint[0].GetDutyCycle());
|
||||||
|
pin25.write(joint[1].GetDutyCycle());
|
||||||
|
pin24.write(joint[2].GetDutyCycle());
|
||||||
|
pin23.write(joint[3].GetDutyCycle());
|
||||||
|
pin22.write(joint[4].GetDutyCycle());
|
||||||
|
pin21.write(joint[5].GetDutyCycle());
|
||||||
|
|
||||||
|
}
|
||||||
|
} |
||||||
|
|
||||||
|
*/ |
||||||
Loading…
Reference in new issue