Hilfe bei Programmablauf (µPython LED Pendel)

[Kolja L. (kolja82)]

Nabend

Nachdem mein erster Thread in eine Pythonmachbarkeitsstudie ausgeartet 
ist,
von der ich nun wirklich nichts verstehe, fange ich hier von vorne an:


Ich habe: einen ESP8266 mit Micropython, einen Beschleunigungssensor 
(MPU6050) und ein paar WS2812 LEDs.
Der Aufbau pendelt an dem USB Kabel.

Ich möchte: die LEDs so ansteuern, dass sie, je nach Position des 
Pendels, eine andere Farbe haben. Das Pendel soll nicht immer gleich 
lang sein und nicht immer gleich hoch ausschlagen.

Mein Ansatz: Wendepunkte des Pendels erkennen, dazwischen die Zeit 
messen, Zeit durch die Anzahl der Schritte des Farbverlaufes teilen, 
wenn diese Zeit verstrichen ist, den Wert des Farbverlaufen um eins 
erhöhen. Dass bis zum anderen Wendepunkt, welcher erkannt wird und das 
Spiel geht von vorne los.

Was funktioniert: Sensor auslesen und Werte glätten, LEDs ansteuern, 
Wendepunkte des Pendels (Hoch- und Tiefpunkt von GyZ) erkennen und die 
Zeit dazwischen messen. Also alles was ich brauche im Einzelnen.

Mein Problem: Ich verzettele mich in Funktionen die Funktionen aufrufen.

from machine import I2C, Pin
import time
import utime
import mpu6050
import math
import machine, neopixel

np = neopixel.NeoPixel(machine.Pin(13), 16)
i2c = I2C(scl=Pin(5), sda=Pin(4))
accel = mpu6050.accel(i2c)


# HSV values in [0..1]  returns (r, g, b) values from 0 to 255
def hsv_to_rgb(h, s, v):
    h_i = int((h*6))
    f = h*6 - h_i
    p = v * (1 - s)
    q = v * (1 - f*s)
    t = v * (1 - (1 - f) * s)

    if h_i==0: r, g, b = v, t, p
    elif h_i==1: r, g, b = q, v, p
    elif h_i==2: r, g, b = p, v, t
    elif h_i==3: r, g, b = p, q, v
    elif h_i==4: r, g, b = t, p, v
    elif h_i==5: r, g, b = v, p, q
    else: r, g, b = 0, 0, 0
    return (int(r*255), int(g*255), int(b*255))

## LEDs mir HSV Wert einschalten
def LED_an(hsv_value):
    hsv_value = hsv_value / 100
    for j in range(0, 2):
        np[j] = hsv_to_rgb(hsv_value, 0.9, 0.21) 
    np.write()

## LEDs mit HSV aufrufen und anschließend HSV erhöhen
hsv = 0
schritt = 1
def led_verlauf():
    global hsv
    LED_an(hsv)
    #print(hsv)
    hsv += schritt
    if hsv > 100: hsv = 0

## Zeitmessung
zeit2 = 0
zeit1 = 0 
def zeitmessung():
    global zeit1, zeit2
    zeit1 = utime.ticks_ms() - zeit2
    #print(zeit1)
    zeit2 = utime.ticks_ms()


## Zeitmessung für LED Update
after_now = utime.ticks_ms()
zeitschritt = zeit1 / 100
def LED_zeit():
    global after_now, zeitschritt
    now = utime.ticks_ms()
    if utime.ticks_diff(now, after_now) > zeitschritt:
        led_verlauf()
        print(zeit1)
        after_now = now
        
        
## Vars for LOOP
state = 1
wert_alt = 0 

## START
print("Start")


## THE LOOP
while True: 
    wert_neu = accel.get_smoothed_values().get("GyZ")
    #print(wert_neu)
    
    
    if wert_neu > 0:
        if wert_alt < wert_neu and state == 0:
            wert_alt = wert_neu
            print(state)
            state = 1
            hsv = 0
            zeitmessung()


    if wert_neu < 0:
        if wert_alt > wert_neu and state == 1:
            wert_alt = wert_neu
            print(state)
            state = 0
            hsv = 0
            zeitmessung()


    LED_zeit()

Könnt Ihr mir da raus helfen, indem ihr mich auf einen anderen Weg 
bringt?