2DOF controller given by rakhi, updated