If you have more time, you should add Fatehpur Sikri to your itinerary, which is located between Agra and Mathura. It is a beautiful ancient town and home to many historical monuments.
If you have less time, you can skip Mathura and head straight to Vrindavan from Agra to experience the spirituality of this holy city.