Script to test functionality of roboarm functions