I'm a bit late to your thread... been fighting the new 'puter and helping "the kid" all
weekend.

As to list of new things to add. Consider a servo on the knee and link it to tool height
when doing a manual tool change. Your 2 1/2 axis machine suffers from too small a Z range
and this solves the issue.

Karl