wp: moved waypoint commands to a module
auxopt: moved auxopt command to a module
removed unused servo function and load relay module