Rob_Manip Kinematic and dynamic functions along with outlines of general control code for robot manipulators