The Industrial Raspberry Pi Forum

Code: Select all

#!/usr/bin/env python3
# -*- coding: utf-8 -*-
"""
from time import sleep
import RPi.GPIO as GPIO

def calibrate():
    
    print('\nCalibrating divice...\n')
    
    # GPIO setup
    GPIO.setmode(GPIO.BOARD)
    
    # Raspberry Pi pin set for TB6600 driver
    ENA = 37
    DIR = 35
    PUL = 33
    
    # set upward movement 
    #up = GPIO.HIGH
    # set down ward movemnt 
    #down = GPIO.LOW
    
    ENA_Locked = GPIO.LOW
    # ENA_Released = GPIO.HIGH
    
    GPIO.setwarnings(False)
    GPIO.setup(DIR, GPIO.OUT)
    GPIO.setup(PUL, GPIO.OUT)
    GPIO.setup(ENA, GPIO.OUT)
    
    # activate and hold motor
    GPIO.output(ENA, ENA_Locked)
            
    # set upward movement
    GPIO.output(DIR, GPIO.HIGH)
    
    # load and calculate microsteps for upward movement
    with open('./bin/config.yaml', 'r') as f:
        config = yaml.safe_load(f)
    
    mcsCal = int(config["McS"] * 1.10)    
    for i in range(mcsCal):

        # Puls modeling
        GPIO.output(PUL, GPIO.HIGH)
        sleep(0.0001)

        GPIO.output(PUL, GPIO.LOW)
        sleep(0.0001)
    
    # set downward movement
    GPIO.output(DIR, GPIO.LOW)
    
    # load and calculate microsteps steps of two total turns: ttTu
    with open('./bin/manSP.yaml', 'r') as f:
        manSP = yaml.safe_load(f)
    
    ttTu = manSP["stepsPT"] * 2
    for i in range(ttTu):
        
        # Puls modeling
        GPIO.output(PUL, GPIO.HIGH)
        sleep(0.0001)

        GPIO.output(PUL, GPIO.LOW)
        sleep(0.0001)
        
    # clear GPIO signals
    GPIO.cleanup()