A few weeks ago I started working on an Arduino based simple servo controller and I wanted to throw an LCD screen in it so I could see and note the position of each servo.
Nice job. Here is some code you might be interested in, it is my instructable but not my code - came from Oleg Mazurov and it provides xyz positioning (inverse kinematics). Pretty easy to follow it if you look at his website and check out the spreadsheet that shows calculations and graphics.
I think robotic arms are underrated. Lots more cool stuff could be done with them but it seems most builders just build one, play with it a while and stick it in the closet.
Poor lonely machines.
@ChrisStrickland1 Yes, it will work with the Arduino Mega without issue.
You can use the same shield and the same code since the first half of the Arduino Mega is basically an Arduino Uno (with some minor differences but they won’t matter here).