Motion Control project Attempt2