Moved Testfcn to Misc Folder.
Added a practice function illustrating how an improved joint system might be implemented.
Deleting old testfcn.