|
|
|
@ -68,21 +68,23 @@ class Table:
|
|
|
|
|
- Zero distances is stop
|
|
|
|
|
"""
|
|
|
|
|
|
|
|
|
|
# Calculate target height
|
|
|
|
|
targetHeight = self.currentHeight() + distance
|
|
|
|
|
# Calculate target height (Assuming we're measuring the distance
|
|
|
|
|
# to the ceiling)
|
|
|
|
|
targetHeight = self.currentHeight() - distance
|
|
|
|
|
|
|
|
|
|
# Default to not move in any direction
|
|
|
|
|
direction = 0
|
|
|
|
|
|
|
|
|
|
while True:
|
|
|
|
|
# Calculate how far to move
|
|
|
|
|
currentHeightDiff = targetHeight - self.currentHeight()
|
|
|
|
|
currentHeightDiff = (self.currentHeight() - targetHeight) * -1
|
|
|
|
|
|
|
|
|
|
# Calculate which direction to move in
|
|
|
|
|
# Calculate which direction to move in (Assuming that we're
|
|
|
|
|
# measuring the diff height to the ceiling)
|
|
|
|
|
if currentHeightDiff > 1:
|
|
|
|
|
direction = 1
|
|
|
|
|
elif currentHeightDiff < -1:
|
|
|
|
|
direction = -1
|
|
|
|
|
elif currentHeightDiff < -1:
|
|
|
|
|
direction = 1
|
|
|
|
|
else:
|
|
|
|
|
# Reset the relays
|
|
|
|
|
self.triggerRelay(0)
|
|
|
|
|