DarkPaw Robot code

[Tyrelex78]

Hello, I looking for some support with the modification of an existing code for Adeept _DarkPaw spider robot. I looking to modify this code to able to use a ps4 controller.

[Larz60+]

OK, for someone to help, you need to first post your cond (use bbcode tags)

[Tyrelex78]

rom pyPS4Controller.controller import Controller, Event


class MyController(Controller):

def __init__(self, **kwargs):
Controller.__init__(self, **kwargs)

def on_x_press(self):
print("Hello world")

def on_x_release(self):
print("Goodbye world")


class MyEventDefinition(Event):

def __init__(self, **kwargs):
Event.__init__(self, **kwargs)

# each overloaded function, has access to:
# - self.button_id
# - self.button_type
# - self.value
# use those variables to determine which button is being pressed
def x_pressed(self):
return self.button_id == 0 and self.button_type == 1 and self.value == 1

def x_released(self):
return self.button_id == 0 and self.button_type == 1 and self.value == 0

controller = MyController(interface="/dev/input/js0", connecting_using_ds4drv=False, event_definition=MyEventDefinition)
controller.debug = True # you will see raw data stream for any button press, even if that button is not mapped
# you can start listening before controller is paired, as long as you pair it within the timeout window
controller.listen(timeout=60)

[Tyrelex78]

#!/usr/bin/env python3
# File name : servo.py
# Description : Control Servos
# Author : William
# Date : 2019/02/23
from __future__ import division
import time
import RPi.GPIO as GPIO
import sys
import Adafruit_PCA9685

'''
change this form 1 to 0 to reverse servos
'''
pwm0_direction = 1
pwm1_direction = 1
pwm2_direction = 1
pwm3_direction = 1


pwm = Adafruit_PCA9685.PCA9685()
pwm.set_pwm_freq(50)

pwm0_init = 300
pwm0_max = 450
pwm0_min = 150
pwm0_pos = pwm0_init

pwm1_init = 300
pwm1_max = 480
pwm1_min = 160
pwm1_pos = pwm1_init

pwm2_init = 300
pwm2_max = 500
pwm2_min = 100
pwm2_pos = pwm2_init

pwm3_init = 300
pwm3_max = 500
pwm3_min = 300
pwm3_pos = pwm3_init

org_pos = 300


def ctrl_range(raw, max_genout, min_genout):
if raw > max_genout:
raw_output = max_genout
elif raw < min_genout:
raw_output = min_genout
else:
raw_output = raw
return int(raw_output)


def camera_ang(direction, ang):
global org_pos
if ang == 'no':
ang = 50
if look_direction:
if direction == 'lookdown':
org_pos+=ang
org_pos = ctrl_range(org_pos, look_max, look_min)
elif direction == 'lookup':
org_pos-=ang
org_pos = ctrl_range(org_pos, look_max, look_min)
elif direction == 'home':
org_pos = 300
else:
if direction == 'lookdown':
org_pos-=ang
org_pos = ctrl_range(org_pos, look_max, look_min)
elif direction == 'lookup':
org_pos+=ang
org_pos = ctrl_range(org_pos, look_max, look_min)
elif direction == 'home':
org_pos = 300

pwm.set_all_pwm(13,org_pos)


def lookleft(speed):
global pwm0_pos
if pwm0_direction:
pwm0_pos += speed
pwm0_pos = ctrl_range(pwm0_pos, pwm0_max, pwm0_min)
pwm.set_pwm(12, 0, pwm0_pos)
else:
pwm0_pos -= speed
pwm0_pos = ctrl_range(pwm0_pos, pwm0_max, pwm0_min)
pwm.set_pwm(12, 0, pwm0_pos)


def lookright(speed):
global pwm0_pos
if pwm0_direction:
pwm0_pos -= speed
pwm0_pos = ctrl_range(pwm0_pos, pwm0_max, pwm0_min)
pwm.set_pwm(12, 0, pwm0_pos)
else:
pwm0_pos += speed
pwm0_pos = ctrl_range(pwm0_pos, pwm0_max, pwm0_min)
pwm.set_pwm(12, 0, pwm0_pos)


def up(speed):
global pwm1_pos
if pwm1_direction:
pwm1_pos -= speed
pwm1_pos = ctrl_range(pwm1_pos, pwm1_max, pwm1_min)
pwm.set_pwm(13, 0, pwm1_pos)
else:
pwm1_pos += speed
pwm1_pos = ctrl_range(pwm1_pos, pwm1_max, pwm1_min)
pwm.set_pwm(13, 0, pwm1_pos)
#print(pwm1_pos)


def down(speed):
global pwm1_pos
if pwm1_direction:
pwm1_pos += speed
pwm1_pos = ctrl_range(pwm1_pos, pwm1_max, pwm1_min)
pwm.set_pwm(13, 0, pwm1_pos)
else:
pwm1_pos -= speed
pwm1_pos = ctrl_range(pwm1_pos, pwm1_max, pwm1_min)
pwm.set_pwm(13, 0, pwm1_pos)
#print(pwm1_pos)

def lookup(speed):
global pwm2_pos
if pwm2_direction:
pwm2_pos -= speed
pwm2_pos = ctrl_range(pwm2_pos, pwm2_max, pwm2_min)
pwm.set_pwm(13, 0, pwm2_pos)
else:
pwm2_pos += speed
pwm2_pos = ctrl_range(pwm2_pos, pwm2_max, pwm2_min)
pwm.set_pwm(13, 0, pwm2_pos)


def lookdown(speed):
global pwm2_pos
if pwm2_direction:
pwm2_pos += speed
pwm2_pos = ctrl_range(pwm2_pos, pwm2_max, pwm2_min)
pwm.set_pwm(13, 0, pwm2_pos)
else:
pwm2_pos -= speed
pwm2_pos = ctrl_range(pwm2_pos, pwm2_max, pwm2_min)
pwm.set_pwm(13, 0, pwm2_pos)


def grab(speed):
global pwm3_pos
if pwm3_direction:
pwm3_pos -= speed
pwm3_pos = ctrl_range(pwm3_pos, pwm3_max, pwm3_min)
pwm.set_pwm(3, 0, pwm3_pos)
else:
pwm3_pos += speed
pwm3_pos = ctrl_range(pwm3_pos, pwm3_max, pwm3_min)
pwm.set_pwm(3, 0, pwm3_pos)
print(pwm3_pos)


def loose(speed):
global pwm3_pos
if pwm3_direction:
pwm3_pos += speed
pwm3_pos = ctrl_range(pwm3_pos, pwm3_max, pwm3_min)
pwm.set_pwm(3, 0, pwm3_pos)
else:
pwm3_pos -= speed
pwm3_pos = ctrl_range(pwm3_pos, pwm3_max, pwm3_min)
pwm.set_pwm(3, 0, pwm3_pos)
print(pwm3_pos)


def servo_init():
pwm.set_pwm(0, 0, pwm0_pos)
pwm.set_pwm(1, 0, pwm1_pos)
pwm.set_pwm(2, 0, pwm2_max)
pwm.set_pwm(3, 0, pwm3_pos)


def clean_all():
global pwm
pwm = Adafruit_PCA9685.PCA9685()
pwm.set_pwm_freq(50)
pwm.set_all_pwm(0, 0)


def ahead():
global pwm0_pos, pwm1_pos
pwm.set_pwm(0, 0, pwm0_init)
pwm.set_pwm(1, 0, (pwm1_max-20))
pwm0_pos = pwm0_init
pwm1_pos = pwm1_max-20


def get_direction():
return (pwm0_pos - pwm0_init)


if __name__ == '__main__':
while True:
for i in range(0,100):
pwm.set_pwm(0, 0, (300+i))
time.sleep(0.05)
for i in range(0,100):
pwm.set_pwm(0, 0, (400-i))
time.sleep(0.05)