Created pickup and dispose functions, very, very untested, also still crude, but should work once correct servo values have been entered