From 1acb3756363a8e024edd32a84f45a314ea8a63f9 Mon Sep 17 00:00:00 2001
From: Patrick Tschuchnig <patrick.tschuchnig@wolfsberg.local>
Date: Wed, 24 Oct 2018 13:15:25 +0200
Subject: [PATCH] =?UTF-8?q?Erste=20=C3=BCberarbeitete=20Version?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 KranClass.py  |  62 +++++++++++
 KranClass.pyc | Bin 0 -> 2562 bytes
 robot.py      | 290 ++++++++++++++++++++++++++++++++++++++++++++++++++
 testkeys.py   |   9 ++
 4 files changed, 361 insertions(+)
 create mode 100644 KranClass.py
 create mode 100644 KranClass.pyc
 create mode 100755 robot.py
 create mode 100644 testkeys.py

diff --git a/KranClass.py b/KranClass.py
new file mode 100644
index 0000000..b049975
--- /dev/null
+++ b/KranClass.py
@@ -0,0 +1,62 @@
+import RPi.GPIO as GPIO
+
+class Kran:
+
+    def __init__(self, minus, plus, greifer, handgelenk, ellenbogen, armgelenk, basis, licht):
+        self.__Minus = minus
+        self.__Plus = plus
+        self.__Greifer = greifer
+        self.__Handgelenk = handgelenk
+        self.__Ellenbogen = ellenbogen
+        self.__Armgelenk = armgelenk
+        self.__Basis = basis
+        self.__Licht = licht
+        self.__pin_list = [minus, plus, greifer, handgelenk, ellenbogen, armgelenk, basis, licht]
+        self.__pin_list_plus = [greifer, handgelenk, ellenbogen, armgelenk, basis, licht]
+
+        GPIO.setmode(GPIO.BOARD)
+        GPIO.setup(self.__pin_list, GPIO.OUT)
+        self.move(0, 0)
+
+    def cleanup(self):
+        GPIO.cleanup(1)
+
+    def reset(self):
+        GPIO.output(self.__pin_list, 1)
+
+    def __on(self, on_pin):
+        GPIO.output(on_pin, 0)
+        GPIO.output(self.__Plus, 0)
+
+    def __off(self, out_pin):
+        GPIO.output(self.__pin_list_plus, 0)
+        GPIO.output(out_pin, 1)
+        GPIO.output(self.__Minus, 0)
+
+    def move(self, was, wie):
+        if was == "G" and wie == 1:
+            self.__on(self.__Greifer)
+        elif was == "G" and wie == 2:
+            self.__off(self.__Greifer)
+        elif was == "H" and wie == 1:
+            self.__on(self.__Handgelenk)
+        elif was == "H" and wie == 2:
+            self.__off(self.__Handgelenk)
+        elif was == "E" and wie == 1:
+            self.__on(self.__Ellenbogen)
+        elif was == "E" and wie == 2:
+            self.__off(self.__Ellenbogen)
+        elif was == "A" and wie == 1:
+            self.__on(self.__Armgelenk)
+        elif was == "A" and wie == 2:
+            self.__off(self.__Armgelenk)
+        elif was == "B" and wie == 1:
+            self.__on(self.__Basis)
+        elif was == "B" and wie == 2:
+            self.__off(self.__Basis)
+
+        elif was == "L" and wie == 1:
+            self.__on(self.__Licht)
+
+        else:
+            print "no match!!!!!"
diff --git a/KranClass.pyc b/KranClass.pyc
new file mode 100644
index 0000000000000000000000000000000000000000..3063a93e3b8f61e2b63519f633f570d246aabb09
GIT binary patch
literal 2562
zcmbVN-EJF26h5>5Pn#zER}=)55Evm6#3e!%Nm?a{l0?&jXb@Vt_Bz>Qy|z4KDx}_^
zAjAXk7zhb*#SO24khtO%cmVjmGuz!&g8*ZDj=wW==9_cQoSA9-vAXi@lRw=XO7Usn
z|2;JKD#QpsBbmslks~9cNJdQ=HRLOibCG*T(2d;bw_uw7iO;@o0)8+b<Rza$$2OX~
z0g;H(2noVuf(D5R9&sPFxDI>TGHNO4h`rNqgJRf&VC$mopt+wR9vXQl5(7jEpf(gh
zZ7P7;QUJBB0BT18)UE=kn20Gbh8YYngwC!U2Ls59LxHU)enn0%sk|)bMhx{;@}73J
z_llfHVyLe%ZTL|i2@)6~g#8pk`s)z>GDOTY#_@+~zHt6h)p3|Xzf$SD^CTT7bN@uu
zwKvE|$4QptXZ7A&8G7zdkCWVUk%E6~J}FFVi*65G>grzHPKPJnuT|4#X&z^=@lRju
zi)VDPiGkh2_YZsrz$Jb%9VMQXvVE{+Zz@9XV&++K2Or(l36tsPNuRr`noF{=8cs9`
zWK?Q09v5M+0H0LxQcbErNi`@V<m&e|G@^_#^#MeMdl6{!WI9PUXX)n6#GU!+Y?GU?
zlMS5Pn0?_{a&esIsgGkaxaT3n^d9?OH`k(d^Q;-N_Sv|-TB_V5ucwK-j~c1%J`J@H
zEH_)THq4SizL@nnWI1;kZ|yZqcm~aJd8xc%zSW!O0D?CxN<GVuRiyev``{DL-*n+;
z3vZd&|L2!(=sdyRUj@e_=jbC_>D+5j3g^nR^3Tp<g7iyg?F&#XDML~<^%_7Pqj;Ce
zq}E~_PjhC}u?oeko8bkQ-@(A&xL8FI>4~pQaPieH0lFS8fmHL(g*5LW6jrvaibUh#
zLBNJA9T1Bb0gcBm0XSww%u|esKCm&i9W?hlR>Y+UKhGkWzrouPmvw<rH5k=;W-;eK
zn#%NJHEpOVuohU&^cyv8>hPB}R^XDgp+_YDtY-RMjTN|LEll55)0VRSQey=!S(|~i
zQ!|YW!wS9vm#l^9Z<>L&vc9RNAp^iAYb&t+P&56c#tK}r7N%dTX-8SlYplQ}Ydf%h
zS~LB=#tK}r7N&2hX;)c)t+4`^tewD$N46)sdwK=2xb{7(YgdaeWdW$Zr}CD{EtT6U
zZ@X2P<kOcY13x^u&QG8Bqvy>~ye-q*vY7A?R$b$<)xu^8T2`KA5nE0ThgS=m(;f_*
zz6}r3WSP@y`MAA;<~AV2Tt#L7hZe!65h9>3ahwk(NgM~?V?17q465aguQ#jZb7AS2
zeVu}<R&FZ#_ZP)tlAbrm$G08z)_V<no4r<`((H9HWDnB~KBnP5;H;(B(%0+V5XcSg
Jv|hby(O)Fv$Q=Lx

literal 0
HcmV?d00001

diff --git a/robot.py b/robot.py
new file mode 100755
index 0000000..1e9d8b4
--- /dev/null
+++ b/robot.py
@@ -0,0 +1,290 @@
+#!/usr/bin/python2.7
+# -*- coding: latin-1 -*-
+
+from KranClass import Kran
+from evdev import *
+from select import select
+from multiprocessing import Process
+import time
+#  
+# 
+# gpio:	 minus plus greifer handgelenk ellenbogen armgelenk basis licht
+#	
+# gpio:	    3    5     7         8          11        10      12     16
+# gpio:	   40   38    37        36          35        33      32     31
+#
+# key r1:	     o l       p ö	   ü ä       + #     . -      ,   
+# key r2:            q a       w s         e d       r f     x c      y
+#
+# rel  1: in1  in2   in4       in3         in5       in7     in6    in8
+# rel  2: in1  in2   in4       in3         in5       in7     in6    in8 
+
+robot1 = Kran( 3,  5,  7,  8, 11, 10, 12, 16)
+robot2 = Kran(40, 38, 37, 36, 35, 33, 32, 31)
+
+dev = InputDevice('/dev/input/event1')
+
+def robot1func(event1):
+
+# handgelenk on
+# taste p 
+
+    if event1.code == 25:
+        robot1.move("H", 1)
+        return 1
+
+# handgelenk off
+# taste ö
+
+    elif event1.code == 39:
+        robot1.move("H", 2)
+        return 1
+
+# ellenbogen on
+# taste ü
+
+    elif event1.code == 26:
+        robot1.move("E", 1)
+        return 1
+
+# ellenbogen off
+# taste ä
+
+    elif event1.code == 40:
+        robot1.move("E", 2)
+        return 1
+
+# armgelenk on
+# taste +
+
+    elif event1.code == 27:
+        robot1.move("A", 1)
+        return 1
+
+# armgelenk off
+# taste #
+
+    elif event1.code == 43:
+        robot1.move("A", 2)
+        return 1
+
+# basis off 
+# taste .
+
+    elif event1.code == 52:
+        robot1.move("B", 2)
+        return 1
+
+# basis on
+# taste -
+
+    elif event1.code == 53:
+        robot1.move("B", 1)
+        return 1
+
+# greifer off
+# taste o
+
+    elif event1.code == 24:
+        robot1.move("G", 2)
+        return 1
+
+# greifer on
+# taste l
+
+    elif event1.code == 38:
+        robot1.move("G", 1)
+        return 1
+
+# licht on
+# taste ,
+
+    elif event1.code == 51:
+        robot1.move("L", 1)
+        return 1
+
+# taste m
+
+    elif event1.code == 50:
+        robot1.cleanup()
+        robot2.cleanup()
+        return 1
+
+
+def robot2func(event2):
+
+# handgelenk on
+# taste w 
+
+    if event2.code == 17:
+        robot2.move("H", 1)
+        return 1
+
+# handgelenk off
+# taste s
+
+    if event2.code == 31:
+	robot2.move("H", 2)
+	return 1
+
+# ellenbogen on
+# taste e
+
+    elif event2.code == 18:
+        robot2.move("E", 1)
+        return 1
+
+# ellenbogen off
+# taste d
+    elif event2.code == 32:
+        robot2.move("E", 2)
+        return 1
+
+# arm on
+# taste r
+
+    elif event2.code == 19:
+        robot2.move("A", 1)
+        return 1
+
+# arm off
+# taste f 
+
+    elif event2.code == 33:
+        robot2.move("A", 2)
+        return 1
+
+# basis off
+# taste x
+
+    elif event2.code == 45:
+        robot2.move("B", 2)
+        return 1
+
+# basis on
+# taste c
+
+    elif event2.code == 46:
+        robot2.move("B", 1)
+        return 1
+
+# greifer off
+# taste q 
+
+    elif event2.code == 16:
+        robot2.move("G", 2)
+        return 1
+
+# greifer on
+# taste a
+
+    elif event2.code == 30:
+        robot2.move("G", 1)
+        return 1
+
+# licht on
+# taste y
+
+    elif event2.code == 44:
+        robot2.move("L", 1)
+        return 1
+
+# taste v
+
+    elif event2.code == 47:
+        robot2.cleanup()
+        return 1
+
+
+def runInParallel(*fns):
+    proc = []
+    for fn in fns:
+        p = Process(target=fn)
+        p.start()
+        proc.append(p)
+    for p in proc:
+        p.join()
+
+
+def manuell():
+    flag1 = 0
+    flag2 = 0
+    for event in dev.read_loop():
+        if event.type == ecodes.EV_KEY:
+            if event.value == 1:
+                if flag1 == 0:
+                    flag1 = robot1func(event)
+                    if not flag1:
+                        flag1 = 0
+
+                if flag2 == 0:
+                    flag2 = robot2func(event)
+                    if not flag2:
+                        flag2 = 0
+
+            if event.value == 0:
+                if flag1 == 1:
+                    if robot1func(event) == 1:
+                        robot1.reset()
+                        flag1 = 0
+
+                if flag2 == 1:
+                    if robot2func(event) == 1:
+                        robot2.reset()
+                        flag2 = 0
+
+
+#def automatic1():
+    robot1.move("G", 1)
+    time.sleep(1.5)
+    robot1.reset()
+    robot1.move("E", 1)
+    time.sleep(4)
+    robot1.reset()
+    robot1.move("B", 2)
+    time.sleep(3)
+    robot1.reset()
+
+    automatic2()
+    robot2.move("B", 2)
+    time.sleep(4)
+    robot2.move("E", 2)
+    time.sleep(4)
+    robot2.reset()
+    robot1.move("B", 1)
+    time.sleep(3)
+    robot1.reset()
+    robot1.move("E", 2)
+    time.sleep(3.5)
+    robot1.reset()
+    robot2.move("E", 1)
+    time.sleep(3)
+    robot2.reset()
+    robot2.move("B", 1)
+    time.sleep(4)
+    robot2.reset()
+    robot2.move("E", 2)
+    time.sleep(1)
+    robot2.reset()
+    robot2.move("G", 2)
+    time.sleep(1)
+    robot2.reset()
+
+
+#def automatic2():
+    robot2.move("E", 2)
+    time.sleep(2)
+    robot2.reset()
+    robot2.move("G", 1)
+    time.sleep(1.5)
+    robot2.reset()
+    robot1.move("G", 2)
+    time.sleep(1)
+    robot1.reset()
+    robot2.move("E", 1)
+    time.sleep(4)
+    robot2.reset()
+
+
+manuell()
+#automatic1()
diff --git a/testkeys.py b/testkeys.py
new file mode 100644
index 0000000..da0ffa0
--- /dev/null
+++ b/testkeys.py
@@ -0,0 +1,9 @@
+#!/bin/python2.7
+import evdev
+device = evdev.InputDevice('/dev/input/event0')
+print(device)
+
+for event in device.read_loop():
+	if event.type == evdev.ecodes.EV_KEY:
+		print(evdev.categorize(event))
+