Ball catcher algorithm for Lego Nxt