Refactoring of AL5D control class

Found a typo in the al5d functions, it was an incorrect home position, that's why the robot was always trying to go down first. But that was overwritten by the interact, since it was taking the values from the sliders in real-time ish. But when using the interact manual it was going down.