code cleaning, tool change works almost (no vacuum on/off after hand was moved)