Lino/RoboterArm
1
0
Fork 0
mirror of https://github.com/LinoSchmidt/RoboterArm.git synced 2026-03-21 02:31:16 +01:00
Code Issues Packages Projects Releases Wiki Activity

code geortnet

Browse Source
This commit is contained in:
LinoSchmidt
2021-09-30 08:35:19 +02:00
parent a90ea48d8c
commit 6a2dce7270
1 changed files with 18 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
src/main.cpp
View File

@@ -5,10 +5,12 @@
#define servoArmPin 7
#define servoOberarmPin 8
#define servoHandPin 9
#define poti1Pin 0
#define poti2Pin 5
#define poti3Pin 2
#define poti4Pin 3
#define loopTime 25
#define PotiFehlerBereich 100
#define AusschaltDelay 80
@@ -22,7 +24,8 @@ int offtime;
bool disabled = false;
void setup(){
void setup()
{
servoDrehung.attach(servoDrehungPin);
servoArm.attach(servoArmPin);
servoOberarm.attach(servoOberarmPin);
@@ -31,7 +34,8 @@ void setup(){
Serial.begin(9600);
}
void loop(){
void loop()
{
Poti1 = analogRead(poti1Pin);
Poti2 = analogRead(poti2Pin);
Poti3 = analogRead(poti3Pin);
@@ -42,12 +46,15 @@ void loop(){
servoOberarmPos = map(Poti3, 0, 1023, 0, 180);
servoHandPos = map(Poti4, 0, 1023, 45, 140);
if(servoDrehungPos <= servoDrehungPosOLD + PotiFehlerBereich && servoDrehungPos >= servoDrehungPosOLD - PotiFehlerBereich && servoArmPos <= servoArmPosOLD + PotiFehlerBereich && servoArmPos >= servoArmPosOLD - PotiFehlerBereich && servoOberarmPos <= servoOberarmPosOLD + PotiFehlerBereich && servoOberarmPos >= servoOberarmPosOLD - PotiFehlerBereich && servoHandPos <= servoHandPosOLD + PotiFehlerBereich && servoHandPos >= servoHandPosOLD - PotiFehlerBereich){
if(offtime < AusschaltDelay){
if (servoDrehungPos <= servoDrehungPosOLD + PotiFehlerBereich && servoDrehungPos >= servoDrehungPosOLD - PotiFehlerBereich && servoArmPos <= servoArmPosOLD + PotiFehlerBereich && servoArmPos >= servoArmPosOLD - PotiFehlerBereich && servoOberarmPos <= servoOberarmPosOLD + PotiFehlerBereich && servoOberarmPos >= servoOberarmPosOLD - PotiFehlerBereich && servoHandPos <= servoHandPosOLD + PotiFehlerBereich && servoHandPos >= servoHandPosOLD - PotiFehlerBereich)
{
if (offtime < AusschaltDelay)
{
offtime++;
}
}
else{
else
{
offtime = 0;
servoDrehungPosOLD = servoDrehungPos;
@@ -56,7 +63,8 @@ void loop(){
servoHandPosOLD = servoHandPos;
}
if(offtime >= AusschaltDelay){
if (offtime >= AusschaltDelay)
{
servoDrehung.detach();
servoArm.detach();
servoOberarm.detach();
@@ -64,8 +72,10 @@ void loop(){
disabled = true;
}
else{
if (disabled){
else
{
if (disabled)
{
servoDrehung.attach(servoDrehungPin);
servoArm.attach(servoArmPin);
servoOberarm.attach(servoOberarmPin);