#!/usr/bin/env python3
#
# mp101-pi-test
# 
# Copyright (C) 2023, Jeff Moe
# 
# This program is free software: you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation, either version 3 of the License, or
# (at your option) any later version.
# 
# This program is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
# GNU General Public License for more details.
# 
# You should have received a copy of the GNU General Public License
# along with this program.  If not, see <http://www.gnu.org/licenses/>.

import RPi.GPIO as GPIO
import time

GPIO.setmode(GPIO.BCM)

print("setup")
GPIO.setup(6, GPIO.OUT)    # Pin 31 GPIO6	Right
GPIO.setup(17, GPIO.OUT)   # Pin 11 GPIO17	Up
GPIO.setup(16, GPIO.OUT)   # Pin 36 GPIO16	Down
GPIO.setup(5, GPIO.OUT)    # Pin 29 GPIO5	Left
#GPIO.setup(32, GPIO.OUT)  # XXX    PWM		Direction
#GPIO.setup(2, GPIO.OUT)   # Pin  2 5V XXX	

print("Right Off")
GPIO.output(6, GPIO.LOW)
print("Left Off")
GPIO.output(5, GPIO.LOW)
print("Down Off")
GPIO.output(16, GPIO.LOW)
print("Up Off")
GPIO.output(17, GPIO.LOW)
time.sleep(1)

print("Left GPIO 5")
GPIO.output(5, GPIO.HIGH)
time.sleep(5)
GPIO.output(5, GPIO.LOW)

print("Right GPIO 6")
GPIO.output(6, GPIO.HIGH)
time.sleep(5)
GPIO.output(6, GPIO.LOW)

print("Down GPIO 16")
GPIO.output(16, GPIO.HIGH)
time.sleep(3)
GPIO.output(16, GPIO.LOW)

print("Up GPIO 17")
GPIO.output(17, GPIO.HIGH)
time.sleep(3)
GPIO.output(17, GPIO.LOW)