The purpose of this lab is to develop a few subroutines (in C or C++) which will be used in future lab assignments.  The subroutines should be written so they are easily used in future programs.  They should be well commented.  The following subroutines should be written:

1. A subroutine which will multiply two homogeneous matrices to form a composite homogeneous matrix; i.e., matrix A and matrix B are input and matrix C is computed as A times B.
2. A subroutine which will transform a point using a given homogeneous matrix; i.e., matrix R and point p_UVW (not augmented with a 1) are input and p_XYZ  is computed as R times p_UVW.
3. A subroutine to compute the inverse of a homogeneous transformation matrix;  i.e., matrix R is input and matrix R^-1 is computed.

You are also required to write a main program which inputs matrix values from the keyboard and calls each of the subroutines to test them.  The following is suggested, but variations are allowed (e.g., menu driven operation): 1) Input matrix A. 2) Input matrix B.  3) Input point p_UVW. 4) Print A times B. 5) Print A^-1. 6) Print A times  p_UVW.  Note that printing A times A^-1 is also a good test.

Some example C and C++ code is given here.