Modified mico controller to incluse joint index