(***********************************************************************

                    Mathematica-Compatible Notebook

This notebook can be used on any computer system with Mathematica 4.0,
MathReader 4.0, or any compatible application. The data for the notebook 
starts with the line containing stars above.

To get the notebook into a Mathematica-compatible application, do one of 
the following:

* Save the data starting with the line of stars above into a file
  with a name ending in .nb, then open the file inside the application;

* Copy the data starting with the line of stars above to the
  clipboard, then use the Paste menu command inside the application.

Data for notebooks contains only printable 7-bit ASCII and can be
sent directly in email or through ftp in text mode.  Newlines can be
CR, LF or CRLF (Unix, Macintosh or MS-DOS style).

NOTE: If you modify the data for this notebook not in a Mathematica-
compatible application, you must delete the line below containing the 
word CacheID, otherwise Mathematica-compatible applications may try to 
use invalid cache data.

For more information on notebooks and Mathematica-compatible 
applications, contact Wolfram Research:
  web: http://www.wolfram.com
  email: info@wolfram.com
  phone: +1-217-398-0700 (U.S.)

Notebook reader applications are available free of charge from 
Wolfram Research.
***********************************************************************)

(*CacheID: 232*)


(*NotebookFileLineBreakTest
NotebookFileLineBreakTest*)
(*NotebookOptionsPosition[     55446,       1195]*)
(*NotebookOutlinePosition[     56345,       1224]*)
(*  CellTagsIndexPosition[     56301,       1220]*)
(*WindowFrame->Normal*)



Notebook[{

Cell[CellGroupData[{
Cell["POV Data for Planar 4R Chain", "Title"],

Cell[BoxData[
    \(Quit[]\)], "Input"],

Cell[CellGroupData[{

Cell["Input Position and Linkage Data", "Section"],

Cell[CellGroupData[{

Cell[BoxData[
    \(data1 = << "\<ThreePosData\>"\)], "Input"],

Cell[BoxData[
    \({{0, 0, 0}, {22, \(-6\), 11}, {68, \(-17\), 13}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(npos = Length[data1]\)], "Input"],

Cell[BoxData[
    \(3\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \({pO, \ pA, \ pB, pC} = << "\<VertexData\>"\)], "Input"],

Cell[BoxData[
    \({{\(-15\), 
        0}, {\(-12.23340699382514`\), \(-2.8571956875574873`\)}, \
{\(-11.962204093248042`\), \(-7.981967927707509`\)}, {5, 1}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \({Th, Ph, \ Ps, \ Ze} = << "\<PosAngles\>"\)], "Input"],

Cell[BoxData[
    \({{5.431719529019564`, 1.8464638793758672`, 
        2.9434846012813454`}, {5.566767035357889`, 3.252809813260752`, 
        2.9586405472726653`}, {3.5786245470207056`, 3.1898391867676175`, 
        3.200283330362072`}, {1.1366767101771609`, 1.9094345058690017`, 
        2.701841818191939`}}\)], "Output"]
}, Open  ]],

Cell[BoxData[
    \(LinkLength[a_, b_] := N[Sqrt[Dot[b - a, b - a]]]\)], "Input"],

Cell[BoxData[
    \(JointAngle[b_, c_] := N[ArcTan[Dot[b, c], Det[{b, c}]]]\)], "Input"],

Cell[CellGroupData[{

Cell[BoxData[
    \(a = LinkLength[pO, \ pA]\)], "Input"],

Cell[BoxData[
    \(3.9771351572221874`\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(b = LinkLength[pC, pB]\)], "Input"],

Cell[BoxData[
    \(19.19354359036827`\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(g = LinkLength[pC, pO]\)], "Input"],

Cell[BoxData[
    \(20.024984394500787`\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(h = LinkLength[pB, pA]\)], "Input"],

Cell[BoxData[
    \(5.131943250533243`\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(BaseTh = JointAngle[{1, 0}, pC - pO]\)], "Input"],

Cell[BoxData[
    \(0.049958395721942765`\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(rem = {{1, 0, 0}, {0, 1, 0}}\)], "Input"],

Cell[BoxData[
    \({{1, 0, 0}, {0, 1, 0}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell["Functions for 4x4 transformations", "Subsection"],

Cell[BoxData[
    \(Disp[t_, 
        d_] := {{Cos[t], \(-Sin[t]\), 0, d[\([1]\)]}, \ {Sin[t], Cos[t], 0, 
          d[\([2]\)]}, {0, 0, 1, 0}, \ {0, 0, 0, 1}}\)], "Input"],

Cell[BoxData[
    \(Zdisp[t_] := Disp[t, {0, 0}]\)], "Input"],

Cell[BoxData[
    \(Xdisp[t_] := Disp[0, {t, 0}]\)], "Input"],

Cell[BoxData[
    \(Ydisp[t_] := Disp[0, {0, t}]\)], "Input"],

Cell[CellGroupData[{

Cell[BoxData[
    \(DtoR = N[Pi/180]\)], "Input"],

Cell[BoxData[
    \(0.017453292519943295`\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(RtoD = N[180/Pi]\)], "Input"],

Cell[BoxData[
    \(57.29577951308232`\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(test = MatrixForm[Disp[DtoR*30, {1, 2}]]\)], "Input"],

Cell[BoxData[
    TagBox[
      RowBox[{"(", "\[NoBreak]", GridBox[{
            {"0.8660254037844387`", \(-0.5`\), "0", "1"},
            {"0.5`", "0.8660254037844387`", "0", "2"},
            {"0", "0", "1", "0"},
            {"0", "0", "0", "1"}
            }], "\[NoBreak]", ")"}],
      (MatrixForm[ #]&)]], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(position = 
      Table[Disp[
          DtoR*data1[\([i, 1]\)], {data1[\([i, 2]\)], 
            data1[\([i, 3]\)]}], {i, npos}]\)], "Input"],

Cell[BoxData[
    \({{{1, 0, 0, 0}, {0, 1, 0, 0}, {0, 0, 1, 0}, {0, 0, 0, 
          1}}, {{0.9271838545667874`, \(-0.374606593415912`\), 
          0, \(-6\)}, {0.374606593415912`, 0.9271838545667874`, 0, 11}, {0, 
          0, 1, 0}, {0, 0, 0, 
          1}}, {{0.37460659341591196`, \(-0.9271838545667874`\), 
          0, \(-17\)}, {0.9271838545667874`, 0.37460659341591196`, 0, 
          13}, {0, 0, 1, 0}, {0, 0, 0, 1}}}\)], "Output"]
}, Open  ]]
}, Open  ]],

Cell[CellGroupData[{

Cell["Kinematics Equations for RR chain", "Subsection"],

Cell[BoxData[
    \(RReqn[t_, a_, p_] := Zdisp[t] . Xdisp[a] . Zdisp[p]\)], "Input"],

Cell[CellGroupData[{

Cell[BoxData[
    \(Keqns = RReqn[theta, a, phi]\)], "Input"],

Cell[BoxData[
    \(Dot::"dotsh" \(\(:\)\(\ \)\) 
      "Tensors \!\({\(\[LeftSkeleton] 1 \[RightSkeleton]\)}\) and \
\!\({\(\({1, 0, 0, 3.9771351572221874`}\)\), \(\({0, 1, 0, 0}\)\), \(\({0, 0, \
1, 0}\)\), \(\({0, 0, 0, 1}\)\)}\) have incompatible shapes."\)], "Message"],

Cell[BoxData[
    \(Dot::"dotsh" \(\(:\)\(\ \)\) 
      "Tensors \!\({\(\[LeftSkeleton] 1 \[RightSkeleton]\)}\) and \!\(\
\[LeftSkeleton] 1 \[RightSkeleton]\) have incompatible shapes."\)], "Message"],

Cell[BoxData[
    \({{{0.9961946980917455`, 0.984807753012208`, 0.9659258262890683`, 
            0.9396926207859084`, 0.9063077870366499`, 0.8660254037844387`, 
            0.8191520442889918`, 0.766044443118978`, 0.7071067811865475`, 
            0.6427876096865394`, 0.5735764363510462`, 0.5000000000000001`, 
            0.42261826174069944`, 0.3420201433256688`, 0.25881904510252074`, 
            0.17364817766693044`, 0.08715574274765836`, 
            6.123233995736766`*^-17, \(-0.08715574274765824`\), \
\(-0.1736481776669303`\), \(-0.25881904510252085`\), \
\(-0.3420201433256687`\), \(-0.42261826174069933`\), \
\(-0.49999999999999983`\), \(-0.5735764363510458`\), \
\(-0.6427876096865394`\), \(-0.7071067811865475`\), \(-0.7660444431189779`\), \
\(-0.8191520442889919`\), \(-0.8660254037844387`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890682`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890684`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844386`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865477`\), \(-0.6427876096865396`\), \
\(-0.5735764363510464`\), \(-0.5000000000000004`\), \
\(-0.42261826174069916`\), \(-0.3420201433256694`\), \
\(-0.25881904510252063`\), \(-0.17364817766693033`\), \(-0.08715574274765825`\
\), \(-1.8369701987210297`*^-16\), 0.08715574274765789`, 
            0.17364817766692997`, 0.2588190451025203`, 0.34202014332566905`, 
            0.42261826174069883`, 0.5000000000000001`, 0.5735764363510462`, 
            0.6427876096865393`, 0.7071067811865474`, 0.7660444431189778`, 
            0.8191520442889915`, 0.8660254037844384`, 0.90630778703665`, 
            0.9396926207859081`, 0.9659258262890683`, 0.984807753012208`, 
            0.9961946980917455`, 
            1.`}, {\(-0.08715574274765817`\), \(-0.17364817766693036`\), \
\(-0.25881904510252074`\), \(-0.3420201433256687`\), \
\(-0.42261826174069944`\), \(-0.5`\), \(-0.573576436351046`\), \
\(-0.6427876096865394`\), \(-0.7071067811865476`\), \(-0.766044443118978`\), \
\(-0.8191520442889918`\), \(-0.8660254037844386`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890683`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890683`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844387`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865476`\), \(-0.6427876096865395`\), \
\(-0.573576436351046`\), \(-0.5`\), \(-0.4226182617406995`\), \
\(-0.3420201433256689`\), \(-0.258819045102521`\), \(-0.17364817766693072`\), \
\(-0.0871557427476582`\), \(-1.2246467991473532`*^-16\), 
            0.08715574274765796`, 0.17364817766693047`, 0.25881904510252035`, 
            0.34202014332566866`, 0.4226182617406993`, 0.5000000000000001`, 
            0.5735764363510458`, 0.6427876096865393`, 0.7071067811865474`, 
            0.7660444431189779`, 0.8191520442889916`, 0.8660254037844384`, 
            0.90630778703665`, 0.9396926207859081`, 0.9659258262890683`, 
            0.984807753012208`, 0.9961946980917455`, 1.`, 
            0.9961946980917455`, 0.9848077530122081`, 0.9659258262890684`, 
            0.9396926207859083`, 0.9063077870366503`, 0.8660254037844386`, 
            0.8191520442889918`, 0.7660444431189781`, 0.7071067811865477`, 
            0.6427876096865396`, 0.5735764363510465`, 0.5000000000000004`, 
            0.4226182617406992`, 0.34202014332566943`, 0.25881904510252074`, 
            0.1736481776669304`, 0.08715574274765832`, 
            2.4492935982947064`*^-16}, 0, 
          0}, {{0.08715574274765817`, 0.17364817766693036`, 
            0.25881904510252074`, 0.3420201433256687`, 0.42261826174069944`, 
            0.5`, 0.573576436351046`, 0.6427876096865394`, 
            0.7071067811865476`, 0.766044443118978`, 0.8191520442889918`, 
            0.8660254037844386`, 0.9063077870366499`, 0.9396926207859083`, 
            0.9659258262890683`, 0.984807753012208`, 0.9961946980917455`, 
            1.`, 0.9961946980917455`, 0.984807753012208`, 
            0.9659258262890683`, 0.9396926207859084`, 0.90630778703665`, 
            0.8660254037844387`, 0.819152044288992`, 0.766044443118978`, 
            0.7071067811865476`, 0.6427876096865395`, 0.573576436351046`, 
            0.5`, 0.4226182617406995`, 0.3420201433256689`, 
            0.258819045102521`, 0.17364817766693072`, 0.0871557427476582`, 
            1.2246467991473532`*^-16, \(-0.08715574274765796`\), \
\(-0.17364817766693047`\), \(-0.25881904510252035`\), \(-0.34202014332566866`\
\), \(-0.4226182617406993`\), \(-0.5000000000000001`\), \
\(-0.5735764363510458`\), \(-0.6427876096865393`\), \(-0.7071067811865474`\), \
\(-0.7660444431189779`\), \(-0.8191520442889916`\), \(-0.8660254037844384`\), \
\(-0.90630778703665`\), \(-0.9396926207859081`\), \(-0.9659258262890683`\), \
\(-0.984807753012208`\), \(-0.9961946980917455`\), \(-1.`\), \
\(-0.9961946980917455`\), \(-0.9848077530122081`\), \(-0.9659258262890684`\), \
\(-0.9396926207859083`\), \(-0.9063077870366503`\), \(-0.8660254037844386`\), \
\(-0.8191520442889918`\), \(-0.7660444431189781`\), \(-0.7071067811865477`\), \
\(-0.6427876096865396`\), \(-0.5735764363510465`\), \(-0.5000000000000004`\), \
\(-0.4226182617406992`\), \(-0.34202014332566943`\), \
\(-0.25881904510252074`\), \(-0.1736481776669304`\), \
\(-0.08715574274765832`\), \(-2.4492935982947064`*^-16\)}, \
{0.9961946980917455`, 0.984807753012208`, 0.9659258262890683`, 
            0.9396926207859084`, 0.9063077870366499`, 0.8660254037844387`, 
            0.8191520442889918`, 0.766044443118978`, 0.7071067811865475`, 
            0.6427876096865394`, 0.5735764363510462`, 0.5000000000000001`, 
            0.42261826174069944`, 0.3420201433256688`, 0.25881904510252074`, 
            0.17364817766693044`, 0.08715574274765836`, 
            6.123233995736766`*^-17, \(-0.08715574274765824`\), \
\(-0.1736481776669303`\), \(-0.25881904510252085`\), \
\(-0.3420201433256687`\), \(-0.42261826174069933`\), \
\(-0.49999999999999983`\), \(-0.5735764363510458`\), \
\(-0.6427876096865394`\), \(-0.7071067811865475`\), \(-0.7660444431189779`\), \
\(-0.8191520442889919`\), \(-0.8660254037844387`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890682`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890684`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844386`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865477`\), \(-0.6427876096865396`\), \
\(-0.5735764363510464`\), \(-0.5000000000000004`\), \
\(-0.42261826174069916`\), \(-0.3420201433256694`\), \
\(-0.25881904510252063`\), \(-0.17364817766693033`\), \(-0.08715574274765825`\
\), \(-1.8369701987210297`*^-16\), 0.08715574274765789`, 
            0.17364817766692997`, 0.2588190451025203`, 0.34202014332566905`, 
            0.42261826174069883`, 0.5000000000000001`, 0.5735764363510462`, 
            0.6427876096865393`, 0.7071067811865474`, 0.7660444431189778`, 
            0.8191520442889915`, 0.8660254037844384`, 0.90630778703665`, 
            0.9396926207859081`, 0.9659258262890683`, 0.984807753012208`, 
            0.9961946980917455`, 1.`}, 0, 0}, {0, 0, 1, 0}, {0, 0, 0, 
          1}} . {{Cos[phi], \(-Sin[phi]\), 0, 
          3.9771351572221874`}, {Sin[phi], Cos[phi], 0, 0}, {0, 0, 1, 0}, {0, 
          0, 0, 1}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(MatrixForm[Keqns]\)], "Input"],

Cell[BoxData[
    TagBox[\({{{0.9961946980917455`, 0.984807753012208`, 0.9659258262890683`, 
              0.9396926207859084`, 0.9063077870366499`, 0.8660254037844387`, 
              0.8191520442889918`, 0.766044443118978`, 0.7071067811865475`, 
              0.6427876096865394`, 0.5735764363510462`, 0.5000000000000001`, 
              0.42261826174069944`, 0.3420201433256688`, 
              0.25881904510252074`, 0.17364817766693044`, 
              0.08715574274765836`, 
              6.123233995736766`*^-17, \(-0.08715574274765824`\), \
\(-0.1736481776669303`\), \(-0.25881904510252085`\), \
\(-0.3420201433256687`\), \(-0.42261826174069933`\), \
\(-0.49999999999999983`\), \(-0.5735764363510458`\), \
\(-0.6427876096865394`\), \(-0.7071067811865475`\), \(-0.7660444431189779`\), \
\(-0.8191520442889919`\), \(-0.8660254037844387`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890682`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890684`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844386`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865477`\), \(-0.6427876096865396`\), \
\(-0.5735764363510464`\), \(-0.5000000000000004`\), \
\(-0.42261826174069916`\), \(-0.3420201433256694`\), \
\(-0.25881904510252063`\), \(-0.17364817766693033`\), \(-0.08715574274765825`\
\), \(-1.8369701987210297`*^-16\), 0.08715574274765789`, 
              0.17364817766692997`, 0.2588190451025203`, 
              0.34202014332566905`, 0.42261826174069883`, 
              0.5000000000000001`, 0.5735764363510462`, 0.6427876096865393`, 
              0.7071067811865474`, 0.7660444431189778`, 0.8191520442889915`, 
              0.8660254037844384`, 0.90630778703665`, 0.9396926207859081`, 
              0.9659258262890683`, 0.984807753012208`, 0.9961946980917455`, 
              1.`}, {\(-0.08715574274765817`\), \(-0.17364817766693036`\), \
\(-0.25881904510252074`\), \(-0.3420201433256687`\), \
\(-0.42261826174069944`\), \(-0.5`\), \(-0.573576436351046`\), \
\(-0.6427876096865394`\), \(-0.7071067811865476`\), \(-0.766044443118978`\), \
\(-0.8191520442889918`\), \(-0.8660254037844386`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890683`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890683`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844387`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865476`\), \(-0.6427876096865395`\), \
\(-0.573576436351046`\), \(-0.5`\), \(-0.4226182617406995`\), \
\(-0.3420201433256689`\), \(-0.258819045102521`\), \(-0.17364817766693072`\), \
\(-0.0871557427476582`\), \(-1.2246467991473532`*^-16\), 
              0.08715574274765796`, 0.17364817766693047`, 
              0.25881904510252035`, 0.34202014332566866`, 
              0.4226182617406993`, 0.5000000000000001`, 0.5735764363510458`, 
              0.6427876096865393`, 0.7071067811865474`, 0.7660444431189779`, 
              0.8191520442889916`, 0.8660254037844384`, 0.90630778703665`, 
              0.9396926207859081`, 0.9659258262890683`, 0.984807753012208`, 
              0.9961946980917455`, 1.`, 0.9961946980917455`, 
              0.9848077530122081`, 0.9659258262890684`, 0.9396926207859083`, 
              0.9063077870366503`, 0.8660254037844386`, 0.8191520442889918`, 
              0.7660444431189781`, 0.7071067811865477`, 0.6427876096865396`, 
              0.5735764363510465`, 0.5000000000000004`, 0.4226182617406992`, 
              0.34202014332566943`, 0.25881904510252074`, 
              0.1736481776669304`, 0.08715574274765832`, 
              2.4492935982947064`*^-16}, 0, 
            0}, {{0.08715574274765817`, 0.17364817766693036`, 
              0.25881904510252074`, 0.3420201433256687`, 
              0.42261826174069944`, 0.5`, 0.573576436351046`, 
              0.6427876096865394`, 0.7071067811865476`, 0.766044443118978`, 
              0.8191520442889918`, 0.8660254037844386`, 0.9063077870366499`, 
              0.9396926207859083`, 0.9659258262890683`, 0.984807753012208`, 
              0.9961946980917455`, 1.`, 0.9961946980917455`, 
              0.984807753012208`, 0.9659258262890683`, 0.9396926207859084`, 
              0.90630778703665`, 0.8660254037844387`, 0.819152044288992`, 
              0.766044443118978`, 0.7071067811865476`, 0.6427876096865395`, 
              0.573576436351046`, 0.5`, 0.4226182617406995`, 
              0.3420201433256689`, 0.258819045102521`, 0.17364817766693072`, 
              0.0871557427476582`, 
              1.2246467991473532`*^-16, \(-0.08715574274765796`\), \
\(-0.17364817766693047`\), \(-0.25881904510252035`\), \(-0.34202014332566866`\
\), \(-0.4226182617406993`\), \(-0.5000000000000001`\), \
\(-0.5735764363510458`\), \(-0.6427876096865393`\), \(-0.7071067811865474`\), \
\(-0.7660444431189779`\), \(-0.8191520442889916`\), \(-0.8660254037844384`\), \
\(-0.90630778703665`\), \(-0.9396926207859081`\), \(-0.9659258262890683`\), \
\(-0.984807753012208`\), \(-0.9961946980917455`\), \(-1.`\), \
\(-0.9961946980917455`\), \(-0.9848077530122081`\), \(-0.9659258262890684`\), \
\(-0.9396926207859083`\), \(-0.9063077870366503`\), \(-0.8660254037844386`\), \
\(-0.8191520442889918`\), \(-0.7660444431189781`\), \(-0.7071067811865477`\), \
\(-0.6427876096865396`\), \(-0.5735764363510465`\), \(-0.5000000000000004`\), \
\(-0.4226182617406992`\), \(-0.34202014332566943`\), \
\(-0.25881904510252074`\), \(-0.1736481776669304`\), \
\(-0.08715574274765832`\), \(-2.4492935982947064`*^-16\)}, \
{0.9961946980917455`, 0.984807753012208`, 0.9659258262890683`, 
              0.9396926207859084`, 0.9063077870366499`, 0.8660254037844387`, 
              0.8191520442889918`, 0.766044443118978`, 0.7071067811865475`, 
              0.6427876096865394`, 0.5735764363510462`, 0.5000000000000001`, 
              0.42261826174069944`, 0.3420201433256688`, 
              0.25881904510252074`, 0.17364817766693044`, 
              0.08715574274765836`, 
              6.123233995736766`*^-17, \(-0.08715574274765824`\), \
\(-0.1736481776669303`\), \(-0.25881904510252085`\), \
\(-0.3420201433256687`\), \(-0.42261826174069933`\), \
\(-0.49999999999999983`\), \(-0.5735764363510458`\), \
\(-0.6427876096865394`\), \(-0.7071067811865475`\), \(-0.7660444431189779`\), \
\(-0.8191520442889919`\), \(-0.8660254037844387`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890682`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890684`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844386`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865477`\), \(-0.6427876096865396`\), \
\(-0.5735764363510464`\), \(-0.5000000000000004`\), \
\(-0.42261826174069916`\), \(-0.3420201433256694`\), \
\(-0.25881904510252063`\), \(-0.17364817766693033`\), \(-0.08715574274765825`\
\), \(-1.8369701987210297`*^-16\), 0.08715574274765789`, 
              0.17364817766692997`, 0.2588190451025203`, 
              0.34202014332566905`, 0.42261826174069883`, 
              0.5000000000000001`, 0.5735764363510462`, 0.6427876096865393`, 
              0.7071067811865474`, 0.7660444431189778`, 0.8191520442889915`, 
              0.8660254037844384`, 0.90630778703665`, 0.9396926207859081`, 
              0.9659258262890683`, 0.984807753012208`, 0.9961946980917455`, 
              1.`}, 0, 0}, {0, 0, 1, 0}, {0, 0, 0, 
            1}} . {{Cos[phi], \(-Sin[phi]\), 0, 
            3.9771351572221874`}, {Sin[phi], Cos[phi], 0, 0}, {0, 0, 1, 
            0}, {0, 0, 0, 1}}\),
      (MatrixForm[ #]&)]], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(MatrixForm[Simplify[Keqns]]\)], "Input"],

Cell[BoxData[
    TagBox[\({{{0.9961946980917455`, 0.984807753012208`, 0.9659258262890683`, 
              0.9396926207859084`, 0.9063077870366499`, 0.8660254037844387`, 
              0.8191520442889918`, 0.766044443118978`, 0.7071067811865475`, 
              0.6427876096865394`, 0.5735764363510462`, 0.5000000000000001`, 
              0.42261826174069944`, 0.3420201433256688`, 
              0.25881904510252074`, 0.17364817766693044`, 
              0.08715574274765836`, 
              6.123233995736766`*^-17, \(-0.08715574274765824`\), \
\(-0.1736481776669303`\), \(-0.25881904510252085`\), \
\(-0.3420201433256687`\), \(-0.42261826174069933`\), \
\(-0.49999999999999983`\), \(-0.5735764363510458`\), \
\(-0.6427876096865394`\), \(-0.7071067811865475`\), \(-0.7660444431189779`\), \
\(-0.8191520442889919`\), \(-0.8660254037844387`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890682`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890684`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844386`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865477`\), \(-0.6427876096865396`\), \
\(-0.5735764363510464`\), \(-0.5000000000000004`\), \
\(-0.42261826174069916`\), \(-0.3420201433256694`\), \
\(-0.25881904510252063`\), \(-0.17364817766693033`\), \(-0.08715574274765825`\
\), \(-1.8369701987210297`*^-16\), 0.08715574274765789`, 
              0.17364817766692997`, 0.2588190451025203`, 
              0.34202014332566905`, 0.42261826174069883`, 
              0.5000000000000001`, 0.5735764363510462`, 0.6427876096865393`, 
              0.7071067811865474`, 0.7660444431189778`, 0.8191520442889915`, 
              0.8660254037844384`, 0.90630778703665`, 0.9396926207859081`, 
              0.9659258262890683`, 0.984807753012208`, 0.9961946980917455`, 
              1.`}, {\(-0.08715574274765817`\), \(-0.17364817766693036`\), \
\(-0.25881904510252074`\), \(-0.3420201433256687`\), \
\(-0.42261826174069944`\), \(-0.5`\), \(-0.573576436351046`\), \
\(-0.6427876096865394`\), \(-0.7071067811865476`\), \(-0.766044443118978`\), \
\(-0.8191520442889918`\), \(-0.8660254037844386`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890683`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890683`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844387`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865476`\), \(-0.6427876096865395`\), \
\(-0.573576436351046`\), \(-0.5`\), \(-0.4226182617406995`\), \
\(-0.3420201433256689`\), \(-0.258819045102521`\), \(-0.17364817766693072`\), \
\(-0.0871557427476582`\), \(-1.2246467991473532`*^-16\), 
              0.08715574274765796`, 0.17364817766693047`, 
              0.25881904510252035`, 0.34202014332566866`, 
              0.4226182617406993`, 0.5000000000000001`, 0.5735764363510458`, 
              0.6427876096865393`, 0.7071067811865474`, 0.7660444431189779`, 
              0.8191520442889916`, 0.8660254037844384`, 0.90630778703665`, 
              0.9396926207859081`, 0.9659258262890683`, 0.984807753012208`, 
              0.9961946980917455`, 1.`, 0.9961946980917455`, 
              0.9848077530122081`, 0.9659258262890684`, 0.9396926207859083`, 
              0.9063077870366503`, 0.8660254037844386`, 0.8191520442889918`, 
              0.7660444431189781`, 0.7071067811865477`, 0.6427876096865396`, 
              0.5735764363510465`, 0.5000000000000004`, 0.4226182617406992`, 
              0.34202014332566943`, 0.25881904510252074`, 
              0.1736481776669304`, 0.08715574274765832`, 
              2.4492935982947064`*^-16}, 0, 
            0}, {{0.08715574274765817`, 0.17364817766693036`, 
              0.25881904510252074`, 0.3420201433256687`, 
              0.42261826174069944`, 0.5`, 0.573576436351046`, 
              0.6427876096865394`, 0.7071067811865476`, 0.766044443118978`, 
              0.8191520442889918`, 0.8660254037844386`, 0.9063077870366499`, 
              0.9396926207859083`, 0.9659258262890683`, 0.984807753012208`, 
              0.9961946980917455`, 1.`, 0.9961946980917455`, 
              0.984807753012208`, 0.9659258262890683`, 0.9396926207859084`, 
              0.90630778703665`, 0.8660254037844387`, 0.819152044288992`, 
              0.766044443118978`, 0.7071067811865476`, 0.6427876096865395`, 
              0.573576436351046`, 0.5`, 0.4226182617406995`, 
              0.3420201433256689`, 0.258819045102521`, 0.17364817766693072`, 
              0.0871557427476582`, 
              1.2246467991473532`*^-16, \(-0.08715574274765796`\), \
\(-0.17364817766693047`\), \(-0.25881904510252035`\), \(-0.34202014332566866`\
\), \(-0.4226182617406993`\), \(-0.5000000000000001`\), \
\(-0.5735764363510458`\), \(-0.6427876096865393`\), \(-0.7071067811865474`\), \
\(-0.7660444431189779`\), \(-0.8191520442889916`\), \(-0.8660254037844384`\), \
\(-0.90630778703665`\), \(-0.9396926207859081`\), \(-0.9659258262890683`\), \
\(-0.984807753012208`\), \(-0.9961946980917455`\), \(-1.`\), \
\(-0.9961946980917455`\), \(-0.9848077530122081`\), \(-0.9659258262890684`\), \
\(-0.9396926207859083`\), \(-0.9063077870366503`\), \(-0.8660254037844386`\), \
\(-0.8191520442889918`\), \(-0.7660444431189781`\), \(-0.7071067811865477`\), \
\(-0.6427876096865396`\), \(-0.5735764363510465`\), \(-0.5000000000000004`\), \
\(-0.4226182617406992`\), \(-0.34202014332566943`\), \
\(-0.25881904510252074`\), \(-0.1736481776669304`\), \
\(-0.08715574274765832`\), \(-2.4492935982947064`*^-16\)}, \
{0.9961946980917455`, 0.984807753012208`, 0.9659258262890683`, 
              0.9396926207859084`, 0.9063077870366499`, 0.8660254037844387`, 
              0.8191520442889918`, 0.766044443118978`, 0.7071067811865475`, 
              0.6427876096865394`, 0.5735764363510462`, 0.5000000000000001`, 
              0.42261826174069944`, 0.3420201433256688`, 
              0.25881904510252074`, 0.17364817766693044`, 
              0.08715574274765836`, 
              6.123233995736766`*^-17, \(-0.08715574274765824`\), \
\(-0.1736481776669303`\), \(-0.25881904510252085`\), \
\(-0.3420201433256687`\), \(-0.42261826174069933`\), \
\(-0.49999999999999983`\), \(-0.5735764363510458`\), \
\(-0.6427876096865394`\), \(-0.7071067811865475`\), \(-0.7660444431189779`\), \
\(-0.8191520442889919`\), \(-0.8660254037844387`\), \(-0.9063077870366499`\), \
\(-0.9396926207859083`\), \(-0.9659258262890682`\), \(-0.984807753012208`\), \
\(-0.9961946980917455`\), \(-1.`\), \(-0.9961946980917455`\), \
\(-0.984807753012208`\), \(-0.9659258262890684`\), \(-0.9396926207859084`\), \
\(-0.90630778703665`\), \(-0.8660254037844386`\), \(-0.819152044288992`\), \
\(-0.766044443118978`\), \(-0.7071067811865477`\), \(-0.6427876096865396`\), \
\(-0.5735764363510464`\), \(-0.5000000000000004`\), \
\(-0.42261826174069916`\), \(-0.3420201433256694`\), \
\(-0.25881904510252063`\), \(-0.17364817766693033`\), \(-0.08715574274765825`\
\), \(-1.8369701987210297`*^-16\), 0.08715574274765789`, 
              0.17364817766692997`, 0.2588190451025203`, 
              0.34202014332566905`, 0.42261826174069883`, 
              0.5000000000000001`, 0.5735764363510462`, 0.6427876096865393`, 
              0.7071067811865474`, 0.7660444431189778`, 0.8191520442889915`, 
              0.8660254037844384`, 0.90630778703665`, 0.9396926207859081`, 
              0.9659258262890683`, 0.984807753012208`, 0.9961946980917455`, 
              1.`}, 0, 0}, {0, 0, 1, 0}, {0, 0, 0, 
            1}} . {{Cos[phi], \(-Sin[phi]\), 0, 
            3.9771351572221874`}, {Sin[phi], Cos[phi], 0, 0}, {0, 0, 1, 
            0}, {0, 0, 0, 1}}\),
      (MatrixForm[ #]&)]], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(baseO = Disp[BaseTh, pO]\)], "Input"],

Cell[BoxData[
    \({{0.9987523388778446`, \(-0.04993761694389224`\), 
        0, \(-15\)}, {0.04993761694389224`, 0.9987523388778446`, 0, 0}, {0, 
        0, 1, 0}, {0, 0, 0, 1}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(baseC = Disp[BaseTh, pC]\)], "Input"],

Cell[BoxData[
    \({{0.9987523388778446`, \(-0.04993761694389224`\), 0, 
        5}, {0.04993761694389224`, 0.9987523388778446`, 0, 1}, {0, 0, 1, 
        0}, {0, 0, 0, 1}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(dispA = baseO . RReqn[Th[\([1]\)], \ a, \ Ph[\([1]\)]]\)], "Input"],

Cell[BoxData[
    \({{0.05284604434176421`, 0.998602671535295`, 
        0.`, \(-12.23340699382514`\)}, {\(-0.9986026715352951`\), 
        0.0528460443417642`, 0.`, \(-2.857195687557488`\)}, {0.`, 0.`, 1.`, 
        0.`}, {0.`, 0.`, 0.`, 1.`}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(dispB = baseC . RReqn[Ps[\([1]\)], b, \ Ze[\([1]\)]]\)], "Input"],

Cell[BoxData[
    \({{0.05284604434176417`, 0.998602671535295`, 
        0.`, \(-11.962204093248044`\)}, {\(-0.998602671535295`\), 
        0.052846044341764147`, 0.`, \(-7.981967927707506`\)}, {0.`, 0.`, 1.`, 
        0.`}, {0.`, 0.`, 0.`, 1.`}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(handA = Inverse[dispA] . position[\([1]\)]\)], "Input"],

Cell[BoxData[
    \({{0.052846044341764195`, \(-0.9986026715352949`\), 
        0.`, \(-2.2067160782474997`\)}, {0.998602671535295`, 
        0.05284604434176421`, 0.`, 12.367304396010107`}, {0.`, 0.`, 1.`, 
        0.`}, {0.`, 0.`, 0.`, 1.`}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(handB = Inverse[dispB] . position[\([1]\)]\)], "Input"],

Cell[BoxData[
    \({{0.05284604434176414`, \(-0.998602671535295`\), 
        0.`, \(-7.338659328780739`\)}, {0.998602671535295`, 
        0.05284604434176417`, 0.`, 12.367304396010109`}, {0.`, 0.`, 1.`, 
        0.`}, {0.`, 0.`, 0.`, 1.`}}\)], "Output"]
}, Open  ]]
}, Open  ]],

Cell[CellGroupData[{

Cell["Analyse the Linkage", "Subsection"],

Cell[BoxData[
    \(Acoef[t_] := 2*a*b*Cos[t] - 2*g*b\)], "Input"],

Cell[BoxData[
    \(Bcoef[t_] := 2*a*b*Sin[t]\)], "Input"],

Cell[BoxData[
    \(Ccoef[t_] := g^2 + b^2 + a^2 - h^2 - 2*a*g*Cos[t]\)], "Input"],

Cell[BoxData[
    \(Psi[t_, sgn_] := 
      ArcTan[Acoef[t], Bcoef[t]] + 
        sgn*ArcCos[Ccoef[t]/Sqrt[Acoef[t]^2 + Bcoef[t]^2]]\)], "Input"],

Cell[BoxData[
    \(Phi[t_, p_] := 
      ArcTan[b*Cos[p] + g - a*Cos[t], b*Sin[p] - a*Sin[t]] - t\)], "Input"],

Cell[BoxData[
    \(Zet[t_, p_] := 
      ArcTan[b*Cos[p] + g - a*Cos[t], b*Sin[p] - a*Sin[t]] - p\)], "Input"],

Cell[BoxData[
    \(\((AngleMod[p_] := p /; \((p \[GreaterEqual] 0 && p <= 2*Pi)\); 
      AngleMod[p_] := p + 2*Pi /; p < 0; 
      AngleMod[p_] := p - 2  P /; p > 2*Pi)\)\)], "Input"]
}, Open  ]],

Cell[CellGroupData[{

Cell["Input Angles", "Subsection"],

Cell[CellGroupData[{

Cell[BoxData[
    \(inc = 5\)], "Input"],

Cell[BoxData[
    \(5\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(len = 360/inc\)], "Input"],

Cell[BoxData[
    \(72\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(theta = Table[AngleMod[N[inc*i*Pi/180]], \ {i, len}]\)], "Input"],

Cell[BoxData[
    \({0.08726646259971647`, 0.17453292519943295`, 0.2617993877991494`, 
      0.3490658503988659`, 0.4363323129985824`, 0.5235987755982988`, 
      0.6108652381980153`, 0.6981317007977318`, 0.7853981633974483`, 
      0.8726646259971648`, 0.9599310885968813`, 1.0471975511965976`, 
      1.1344640137963142`, 1.2217304763960306`, 1.3089969389957472`, 
      1.3962634015954636`, 1.48352986419518`, 1.5707963267948966`, 
      1.6580627893946132`, 1.7453292519943295`, 1.8325957145940461`, 
      1.9198621771937625`, 2.007128639793479`, 2.0943951023931953`, 
      2.1816615649929116`, 2.2689280275926285`, 2.356194490192345`, 
      2.443460952792061`, 2.530727415391778`, 2.6179938779914944`, 
      2.705260340591211`, 2.792526803190927`, 2.8797932657906435`, 
      2.96705972839036`, 3.0543261909900767`, 3.141592653589793`, 
      3.2288591161895095`, 3.3161255787892263`, 3.4033920413889422`, 
      3.490658503988659`, 3.5779249665883754`, 3.6651914291880923`, 
      3.752457891787808`, 3.839724354387525`, 3.9269908169872414`, 
      4.014257279586958`, 4.101523742186674`, 4.1887902047863905`, 
      4.276056667386108`, 4.363323129985823`, 4.4505895925855405`, 
      4.537856055185257`, 4.625122517784973`, 4.71238898038469`, 
      4.799655442984406`, 4.886921905584122`, 4.974188368183839`, 
      5.061454830783556`, 5.148721293383272`, 5.235987755982989`, 
      5.323254218582705`, 5.410520681182422`, 5.497787143782138`, 
      5.585053606381854`, 5.672320068981571`, 5.759586531581287`, 
      5.846852994181004`, 5.93411945678072`, 6.021385919380437`, 
      6.1086523819801535`, 6.19591884457987`, 6.283185307179586`}\)], "Output"]
}, Open  ]]
}, Open  ]],

Cell[CellGroupData[{

Cell["Output Angles", "Subsection"],

Cell[CellGroupData[{

Cell[BoxData[
    \(sol = \(+1\)\)], "Input"],

Cell[BoxData[
    \(1\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(psiout = 
      Table[{theta[\([i]\)], Psi[theta[\([i]\)], sol]}, \ {i, 
          len}]\)], "Input"],

Cell[BoxData[
    \({{0.08726646259971647`, 3.3522706241408238`}, {0.17453292519943295`, 
        3.333033970399078`}, {0.2617993877991494`, 
        3.315557013204388`}, {0.3490658503988659`, 
        3.2998506287689473`}, {0.4363323129985824`, 
        3.285843906890544`}, {0.5235987755982988`, 
        3.273413076701083`}, {0.6108652381980153`, 
        3.2624070757468404`}, {0.6981317007977318`, 
        3.2526668837363557`}, {0.7853981633974483`, 
        3.2440382917574277`}, {0.8726646259971648`, 
        3.236379200806945`}, {0.9599310885968813`, 
        3.2295629868945044`}, {1.0471975511965976`, 
        3.2234793475508114`}, {1.1344640137963142`, 
        3.2180337093932`}, {1.2217304763960306`, 
        3.2131459303479435`}, {1.3089969389957472`, 
        3.2087487538989365`}, {1.3962634015954636`, 
        3.2047862801021103`}, {1.48352986419518`, 
        3.201212595823275`}, {1.5707963267948966`, 
        3.197990635553847`}, {1.6580627893946132`, 
        3.1950913076873166`}, {1.7453292519943295`, 
        3.1924929076106796`}, {1.8325957145940461`, 
        3.1901808413245005`}, {1.9198621771937625`, 
        3.188147698328275`}, {2.007128639793479`, 
        3.1863937401768068`}, {2.0943951023931953`, 
        3.1849279144111593`}, {2.1816615649929116`, 
        3.1837695686647294`}, {2.2689280275926285`, 
        3.182951136247258`}, {2.356194490192345`, 
        3.18252220457523`}, {2.443460952792061`, 
        3.1825555703826574`}, {2.530727415391778`, 
        3.1831561147534497`}, {2.6179938779914944`, 
        3.184473488774314`}, {2.705260340591211`, 
        3.186719306697354`}, {2.792526803190927`, 
        3.190187744234997`}, {2.8797932657906435`, 
        3.1952728611942773`}, {2.96705972839036`, 
        3.2024638131639636`}, {3.0543261909900767`, 
        3.212284011037998`}, {3.141592653589793`, 
        3.225148442020549`}, {3.2288591161895095`, \(-3.0420017876548426`\)}, \
{3.3161255787892263`, \(-3.0230454832162685`\)}, {3.4033920413889422`, \
\(-3.0017065606770004`\)}, {3.490658503988659`, \(-2.978633280306969`\)}, \
{3.5779249665883754`, \(-2.954441480266433`\)}, {3.6651914291880923`, \
\(-2.9296543300050697`\)}, {3.752457891787808`, \(-2.904698117873509`\)}, \
{3.839724354387525`, \(-2.8799201230334575`\)}, {3.9269908169872414`, \
\(-2.855609724584745`\)}, {4.014257279586958`, \(-2.832016051315308`\)}, \
{4.101523742186674`, \(-2.8093610488333196`\)}, {4.1887902047863905`, \
\(-2.7878486338310204`\)}, {4.276056667386108`, \(-2.7676708914998436`\)}, \
{4.363323129985823`, \(-2.7490121052441894`\)}, {4.4505895925855405`, \
\(-2.732051168115831`\)}, {4.537856055185257`, \(-2.71696272082775`\)}, \
{4.625122517784973`, \(-2.7039172081376415`\)}, {4.71238898038469`, \
\(-2.6930799356416277`\)}, {4.799655442984406`, \(-2.6846091317472425`\)}, \
{4.886921905584122`, \(-2.6786529672753026`\)}, {4.974188368183839`, \
\(-2.675345454654336`\)}, {5.061454830783556`, \(-2.674801141226263`\)}, \
{5.148721293383272`, \(-2.677108532151838`\)}, {5.235987755982989`, \
\(-2.6823222372791946`\)}, {5.323254218582705`, \(-2.6904539466142374`\)}, \
{5.410520681182422`, \(-2.7014625175869518`\)}, {5.497787143782138`, \
\(-2.7152437223651043`\)}, {5.585053606381854`, \(-2.7316205693174007`\)}, \
{5.672320068981571`, \(-2.750335577855387`\)}, {5.759586531581287`, \
\(-2.771046909314274`\)}, {5.846852994181004`, \(-2.793330717921439`\)}, \
{5.93411945678072`, \(-2.816692235732949`\)}, {6.021385919380437`, \
\(-2.840587545229572`\)}, {6.1086523819801535`, \(-2.8644562815476444`\)}, \
{6.19591884457987`, \(-2.8877625027884406`\)}, {6.283185307179586`, \
\(-2.910037356249877`\)}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(angledata = DeleteCases[psiout, {_Real, _Complex}]\)], "Input"],

Cell[BoxData[
    \({{0.08726646259971647`, 3.3522706241408238`}, {0.17453292519943295`, 
        3.333033970399078`}, {0.2617993877991494`, 
        3.315557013204388`}, {0.3490658503988659`, 
        3.2998506287689473`}, {0.4363323129985824`, 
        3.285843906890544`}, {0.5235987755982988`, 
        3.273413076701083`}, {0.6108652381980153`, 
        3.2624070757468404`}, {0.6981317007977318`, 
        3.2526668837363557`}, {0.7853981633974483`, 
        3.2440382917574277`}, {0.8726646259971648`, 
        3.236379200806945`}, {0.9599310885968813`, 
        3.2295629868945044`}, {1.0471975511965976`, 
        3.2234793475508114`}, {1.1344640137963142`, 
        3.2180337093932`}, {1.2217304763960306`, 
        3.2131459303479435`}, {1.3089969389957472`, 
        3.2087487538989365`}, {1.3962634015954636`, 
        3.2047862801021103`}, {1.48352986419518`, 
        3.201212595823275`}, {1.5707963267948966`, 
        3.197990635553847`}, {1.6580627893946132`, 
        3.1950913076873166`}, {1.7453292519943295`, 
        3.1924929076106796`}, {1.8325957145940461`, 
        3.1901808413245005`}, {1.9198621771937625`, 
        3.188147698328275`}, {2.007128639793479`, 
        3.1863937401768068`}, {2.0943951023931953`, 
        3.1849279144111593`}, {2.1816615649929116`, 
        3.1837695686647294`}, {2.2689280275926285`, 
        3.182951136247258`}, {2.356194490192345`, 
        3.18252220457523`}, {2.443460952792061`, 
        3.1825555703826574`}, {2.530727415391778`, 
        3.1831561147534497`}, {2.6179938779914944`, 
        3.184473488774314`}, {2.705260340591211`, 
        3.186719306697354`}, {2.792526803190927`, 
        3.190187744234997`}, {2.8797932657906435`, 
        3.1952728611942773`}, {2.96705972839036`, 
        3.2024638131639636`}, {3.0543261909900767`, 
        3.212284011037998`}, {3.141592653589793`, 
        3.225148442020549`}, {3.2288591161895095`, \(-3.0420017876548426`\)}, \
{3.3161255787892263`, \(-3.0230454832162685`\)}, {3.4033920413889422`, \
\(-3.0017065606770004`\)}, {3.490658503988659`, \(-2.978633280306969`\)}, \
{3.5779249665883754`, \(-2.954441480266433`\)}, {3.6651914291880923`, \
\(-2.9296543300050697`\)}, {3.752457891787808`, \(-2.904698117873509`\)}, \
{3.839724354387525`, \(-2.8799201230334575`\)}, {3.9269908169872414`, \
\(-2.855609724584745`\)}, {4.014257279586958`, \(-2.832016051315308`\)}, \
{4.101523742186674`, \(-2.8093610488333196`\)}, {4.1887902047863905`, \
\(-2.7878486338310204`\)}, {4.276056667386108`, \(-2.7676708914998436`\)}, \
{4.363323129985823`, \(-2.7490121052441894`\)}, {4.4505895925855405`, \
\(-2.732051168115831`\)}, {4.537856055185257`, \(-2.71696272082775`\)}, \
{4.625122517784973`, \(-2.7039172081376415`\)}, {4.71238898038469`, \
\(-2.6930799356416277`\)}, {4.799655442984406`, \(-2.6846091317472425`\)}, \
{4.886921905584122`, \(-2.6786529672753026`\)}, {4.974188368183839`, \
\(-2.675345454654336`\)}, {5.061454830783556`, \(-2.674801141226263`\)}, \
{5.148721293383272`, \(-2.677108532151838`\)}, {5.235987755982989`, \
\(-2.6823222372791946`\)}, {5.323254218582705`, \(-2.6904539466142374`\)}, \
{5.410520681182422`, \(-2.7014625175869518`\)}, {5.497787143782138`, \
\(-2.7152437223651043`\)}, {5.585053606381854`, \(-2.7316205693174007`\)}, \
{5.672320068981571`, \(-2.750335577855387`\)}, {5.759586531581287`, \
\(-2.771046909314274`\)}, {5.846852994181004`, \(-2.793330717921439`\)}, \
{5.93411945678072`, \(-2.816692235732949`\)}, {6.021385919380437`, \
\(-2.840587545229572`\)}, {6.1086523819801535`, \(-2.8644562815476444`\)}, \
{6.19591884457987`, \(-2.8877625027884406`\)}, {6.283185307179586`, \
\(-2.910037356249877`\)}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(ndata = Length[angledata]\)], "Input"],

Cell[BoxData[
    \(72\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(phiout = 
      Table[AngleMod[
          Phi[angledata[\([i, 1]\)], angledata[\([i, 2]\)]]], \ {i, 
          ndata}]\)], "Input"],

Cell[BoxData[
    \({4.069678698690179`, 3.9758749432149525`, 3.891863625409705`, 
      3.8170702814662616`, 3.750713586238397`, 3.691905778203599`, 
      3.639736337547939`, 3.593330987411918`, 3.5518866341847835`, 
      3.514687286939871`, 3.4811070186401487`, 3.4506052010492585`, 
      3.4227178124289983`, 3.397047260786061`, 3.3732521293425335`, 
      3.351037549494586`, 3.3301464688603524`, 3.3103518243728693`, 
      3.2914494830942687`, 3.273251725623252`, 3.255580982820196`, 
      3.23826346956936`, 3.2211222665679875`, 3.2039692582725405`, 
      3.1865951114192095`, 3.168756133253505`, 3.1501563323566857`, 
      3.130422279504499`, 3.1090674832690195`, 3.0854423452588096`, 
      3.058666743868601`, 3.027548826876612`, 2.9905141708883325`, 
      2.9456146692495904`, 2.8907432528761183`, 2.8241517092001316`, 
      2.7451098361634303`, 2.654224829650076`, 2.5531212805983414`, 
      2.4437814087164975`, 2.328026638087236`, 2.2073022824624147`, 
      2.0826680814256164`, 1.9548684916725083`, 1.824413383581394`, 
      1.6916450008761945`, 1.5567876239069864`, 1.4199829148167566`, 
      1.281314914478294`, 1.1408280203844248`, 0.9985404025679561`, 
      0.8544546011734813`, 0.7085665460585382`, 0.5608739067671866`, 
      0.41138446968019515`, 0.2601251053081013`, 
      0.10715179878075531`, \(-0.047438857996084494`\), \
\(-0.20349640152341042`\), \(-0.36080128138755274`\), \
\(-0.519047737674831`\), \(-0.6778251794596963`\), \(-0.8365990531428524`\), \
\(-0.9946930640463751`\), \(-1.1512758396582576`\), \(-1.3053566566151584`\), \
\(-1.4557964125764205`\), \(-1.6013408822378992`\), \(-1.7406821574259546`\), \
\(-1.8725494583329034`\), \(-1.995821503039652`\), \
\(-2.1096413387719117`\)}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(zetout = 
      Table[AngleMod[
          Zet[angledata[\([i, 1]\)], angledata[\([i, 2]\)]]], \ {i, 
          ndata}]\)], "Input"],

Cell[BoxData[
    \({0.8046745371490713`, 0.8173738980153074`, 0.8381060000044673`, 
      0.8662855030961802`, 0.9012019923464356`, 0.9420914771008153`, 
      0.9881944999991141`, 1.0387958044732937`, 1.093246505824804`, 
      1.1509727121300903`, 1.2114751203425254`, 1.2743234046950445`, 
      1.3391481168321127`, 1.4056318068341485`, 1.4735003144393444`, 
      1.5425146709879396`, 1.6124637372322574`, 1.6831575156139191`, 
      1.7544209648015654`, 1.826088070006902`, 1.897995856089742`, 
      1.9699779484348472`, 2.041857166184659`, 2.1134364462545765`, 
      2.184487107747392`, 2.2547330245988757`, 2.3238286179738004`, 
      2.391327661913903`, 2.456638783907348`, 2.51896273447599`, 
      2.5772077777624585`, 2.6298878858325416`, 2.6750345754846987`, 
      2.7102105844759867`, 2.732785432828197`, 2.7405959207693757`, 
      2.732785432828196`, 2.7102105844759845`, 2.675034575484698`, 
      2.62988788583254`, 2.577207777762458`, 2.51896273447599`, 
      2.456638783907347`, 2.391327661913905`, 2.3238286179737937`, 
      2.2547330245988735`, 2.1844871077473935`, 2.113436446254581`, 
      2.041857166184659`, 1.9699779484348516`, 1.8979958560897414`, 
      1.826088070006902`, 1.7544209648015667`, 1.6831575156139182`, 
      1.6124637372322579`, 1.54251467098794`, 1.4735003144393441`, 
      1.4056318068341482`, 1.339148116832113`, 1.2743234046950447`, 
      1.2114751203425256`, 1.1509727121300908`, 1.0932465058248033`, 
      1.0387958044732934`, 0.9881944999991135`, 0.9420914771008164`, 
      0.9012019923464367`, 0.8662855030961831`, 0.8381060000044673`, 
      0.8173738980153082`, 0.8046745371490722`, 
      0.8003960174779663`}\)], "Output"]
}, Open  ]]
}, Open  ]]
}, Open  ]],

Cell[CellGroupData[{

Cell["Generate Data for Animation", "Section"],

Cell[CellGroupData[{

Cell[BoxData[
    \(Reflect = {{1, 0, 0, 0}, {0, 1, 0, 0}, {0, 0, \(-1\), 0}, {0, 0, 0, 
          1}}\)], "Input"],

Cell[BoxData[
    \({{1, 0, 0, 0}, {0, 1, 0, 0}, {0, 0, \(-1\), 0}, {0, 0, 0, 
        1}}\)], "Output"]
}, Open  ]],

Cell[BoxData[
    \(\(DA = 
        Chop[Table[
            Reflect . baseO . 
              RReqn[angledata[\([i, 1]\)], a, phiout[\([i]\)]], {i, 
              ndata}]];\)\)], "Input"],

Cell[BoxData[
    \(\(\(GripA = 
        Chop[Table[
            DA[\([i]\)] . Reflect . handA, {i, 
              ndata}]];\)\(\[IndentingNewLine]\)\)\)], "Input"],

Cell[BoxData[
    \(\(DB = 
        Chop[Table[
            Reflect . baseC . 
              RReqn[angledata[\([i, 2]\)], b, zetout[\([i]\)]], {i, 
              ndata}]];\)\)], "Input"],

Cell[BoxData[
    \(\(GripB = 
        Table[DB[\([i]\)] . Reflect . handB, {i, ndata}];\)\)], "Input"],

Cell[CellGroupData[{

Cell[BoxData[
    \(Chop[GripB - GripA]\)], "Input"],

Cell[BoxData[
    \({{{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}, {0, 0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 
          0, 0, 0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}, {{0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 0}, {0, 0, 0, 
          0}}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell["Write Data to File", "Subsection"],

Cell[CellGroupData[{

Cell["Position information", "Subsubsection"],

Cell[CellGroupData[{

Cell[BoxData[
    \(Trans1 = Reflect . position[\([1]\)]\)], "Input"],

Cell[BoxData[
    \({{1, 0, 0, 0}, {0, 1, 0, 0}, {0, 0, \(-1\), 0}, {0, 0, 0, 
        1}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(Trans2 = Reflect . position[\([2]\)]\)], "Input"],

Cell[BoxData[
    \({{0.9271838545667874`, \(-0.374606593415912`\), 
        0.`, \(-6.`\)}, {0.374606593415912`, 0.9271838545667874`, 0.`, 
        11.`}, {0.`, 0.`, \(-1.`\), 0.`}, {0.`, 0.`, 0.`, 1.`}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(Trans3 = Reflect . position[\([3]\)]\)], "Input"],

Cell[BoxData[
    \({{0.37460659341591196`, \(-0.9271838545667874`\), 
        0.`, \(-17.`\)}, {0.9271838545667874`, 0.37460659341591196`, 0.`, 
        13.`}, {0.`, 0.`, \(-1.`\), 0.`}, {0.`, 0.`, 0.`, 1.`}}\)], "Output"]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
    \(\((PovData = 
        OpenWrite["\<FourBar.inc\>"]; \[IndentingNewLine]WriteString[
        PovData, "\< #declare Trans1 = array[4][4]  \>"]; \
\[IndentingNewLine]Write[PovData, \ Trans1]; \[IndentingNewLine]WriteString[
        PovData, "\< #declare Trans2 = array[4][4]  \>"]; \
\[IndentingNewLine]Write[PovData, \ Trans2]; \[IndentingNewLine]WriteString[
        PovData, "\< #declare Trans3 = array[4][4]  \>"]; \
\[IndentingNewLine]Write[PovData, \ Trans3]; \[IndentingNewLine]WriteString[
        PovData, \ "\< #declare baseO = array[4][4]  \>"]; \
\[IndentingNewLine]Write[PovData, \ baseO]; \[IndentingNewLine]WriteString[
        PovData, \ "\< #declare baseC = array[4][4]  \>"]; \
\[IndentingNewLine]Write[PovData, \ baseC]; \[IndentingNewLine]WriteString[
        PovData, "\< #declare DA = array[\>"]; Write[PovData, \ ndata]; 
      WriteString[PovData, "\<][4][4]  \>"]; 
      Write[PovData, \ DA]; \[IndentingNewLine]WriteString[
        PovData, "\< #declare DB = array[\>"]; Write[PovData, \ ndata]; 
      WriteString[PovData, "\<][4][4]  \>"]; 
      Write[PovData, DB]; \[IndentingNewLine]WriteString[
        PovData, "\< #declare GripA = array[\>"]; Write[PovData, \ ndata]; 
      WriteString[PovData, "\<][4][4]  \>"]; 
      Write[PovData, GripA]; \[IndentingNewLine]Close[
        PovData]\ )\)\)], "Input"],

Cell[BoxData[
    \("FourBar.inc"\)], "Output"]
}, Open  ]],

Cell[BoxData[""], "Input"]
}, Open  ]]
}, Open  ]]
}, Open  ]]
}, Open  ]]
},
FrontEndVersion->"4.0 for Macintosh",
ScreenRectangle->{{0, 1152}, {0, 850}},
WindowSize->{675, 694},
WindowMargins->{{138, Automatic}, {Automatic, 7}},
PrintingCopies->1,
PrintingPageRange->{1, Automatic},
MacintoshSystemPageSetup->"\<\
00<0004/0B`000002mT8o?mooh<<H`Ui0fL5:0?l0080004/0B`000000]P2:001
0000I00000400`<300000BL?00400@00000000000000060801T1T00000040000
00000000000000000000000000000000\>"
]


(***********************************************************************
Cached data follows.  If you edit this Notebook file directly, not using
Mathematica, you must remove the line containing CacheID at the top of 
the file.  The cache data will then be recreated when you save this file 
from within Mathematica.
***********************************************************************)

(*CellTagsOutline
CellTagsIndex->{}
*)

(*CellTagsIndex
CellTagsIndex->{}
*)

(*NotebookFileOutline
Notebook[{

Cell[CellGroupData[{
Cell[1739, 51, 45, 0, 98, "Title"],
Cell[1787, 53, 39, 1, 27, "Input"],

Cell[CellGroupData[{
Cell[1851, 58, 50, 0, 50, "Section"],

Cell[CellGroupData[{
Cell[1926, 62, 62, 1, 27, "Input"],
Cell[1991, 65, 82, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[2110, 71, 53, 1, 27, "Input"],
Cell[2166, 74, 35, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[2238, 80, 75, 1, 27, "Input"],
Cell[2316, 83, 173, 3, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[2526, 91, 74, 1, 27, "Input"],
Cell[2603, 94, 325, 5, 41, "Output"]
}, Open  ]],
Cell[2943, 102, 81, 1, 27, "Input"],
Cell[3027, 105, 88, 1, 27, "Input"],

Cell[CellGroupData[{
Cell[3140, 110, 57, 1, 27, "Input"],
Cell[3200, 113, 53, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[3290, 119, 55, 1, 27, "Input"],
Cell[3348, 122, 52, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[3437, 128, 55, 1, 27, "Input"],
Cell[3495, 131, 53, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[3585, 137, 55, 1, 27, "Input"],
Cell[3643, 140, 52, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[3732, 146, 69, 1, 27, "Input"],
Cell[3804, 149, 55, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[3896, 155, 61, 1, 27, "Input"],
Cell[3960, 158, 56, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[4053, 164, 55, 0, 46, "Subsection"],
Cell[4111, 166, 172, 3, 43, "Input"],
Cell[4286, 171, 61, 1, 27, "Input"],
Cell[4350, 174, 61, 1, 27, "Input"],
Cell[4414, 177, 61, 1, 27, "Input"],

Cell[CellGroupData[{
Cell[4500, 182, 49, 1, 27, "Input"],
Cell[4552, 185, 55, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[4644, 191, 49, 1, 27, "Input"],
Cell[4696, 194, 52, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[4785, 200, 73, 1, 27, "Input"],
Cell[4861, 203, 322, 8, 81, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[5220, 216, 161, 4, 43, "Input"],
Cell[5384, 222, 441, 7, 71, "Output"]
}, Open  ]]
}, Open  ]],

Cell[CellGroupData[{
Cell[5874, 235, 55, 0, 46, "Subsection"],
Cell[5932, 237, 84, 1, 27, "Input"],

Cell[CellGroupData[{
Cell[6041, 242, 61, 1, 27, "Input"],
Cell[6105, 245, 274, 4, 49, "Message"],
Cell[6382, 251, 200, 3, 21, "Message"],
Cell[6585, 256, 7624, 109, 687, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[14246, 370, 50, 1, 27, "Input"],
Cell[14299, 373, 7840, 115, 699, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[22176, 493, 60, 1, 27, "Input"],
Cell[22239, 496, 7840, 115, 699, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[30116, 616, 57, 1, 27, "Input"],
Cell[30176, 619, 193, 3, 41, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[30406, 627, 57, 1, 27, "Input"],
Cell[30466, 630, 187, 3, 41, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[30690, 638, 87, 1, 27, "Input"],
Cell[30780, 641, 258, 4, 41, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[31075, 650, 85, 1, 27, "Input"],
Cell[31163, 653, 260, 4, 41, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[31460, 662, 75, 1, 27, "Input"],
Cell[31538, 665, 257, 4, 41, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[31832, 674, 75, 1, 27, "Input"],
Cell[31910, 677, 254, 4, 41, "Output"]
}, Open  ]]
}, Open  ]],

Cell[CellGroupData[{
Cell[32213, 687, 41, 0, 46, "Subsection"],
Cell[32257, 689, 66, 1, 27, "Input"],
Cell[32326, 692, 58, 1, 27, "Input"],
Cell[32387, 695, 82, 1, 27, "Input"],
Cell[32472, 698, 145, 3, 43, "Input"],
Cell[32620, 703, 111, 2, 27, "Input"],
Cell[32734, 707, 111, 2, 27, "Input"],
Cell[32848, 711, 185, 3, 43, "Input"]
}, Open  ]],

Cell[CellGroupData[{
Cell[33070, 719, 34, 0, 46, "Subsection"],

Cell[CellGroupData[{
Cell[33129, 723, 40, 1, 27, "Input"],
Cell[33172, 726, 35, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[33244, 732, 46, 1, 27, "Input"],
Cell[33293, 735, 36, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[33366, 741, 85, 1, 27, "Input"],
Cell[33454, 744, 1668, 24, 146, "Output"]
}, Open  ]]
}, Open  ]],

Cell[CellGroupData[{
Cell[35171, 774, 35, 0, 46, "Subsection"],

Cell[CellGroupData[{
Cell[35231, 778, 45, 1, 27, "Input"],
Cell[35279, 781, 35, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[35351, 787, 121, 3, 27, "Input"],
Cell[35475, 792, 3670, 60, 341, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[39182, 857, 83, 1, 27, "Input"],
Cell[39268, 860, 3670, 60, 341, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[42975, 925, 58, 1, 27, "Input"],
Cell[43036, 928, 36, 1, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[43109, 934, 151, 4, 43, "Input"],
Cell[43263, 940, 1749, 26, 146, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[45049, 971, 151, 4, 43, "Input"],
Cell[45203, 977, 1689, 25, 146, "Output"]
}, Open  ]]
}, Open  ]]
}, Open  ]],

Cell[CellGroupData[{
Cell[46953, 1009, 46, 0, 50, "Section"],

Cell[CellGroupData[{
Cell[47024, 1013, 115, 2, 27, "Input"],
Cell[47142, 1017, 104, 2, 26, "Output"]
}, Open  ]],
Cell[47261, 1022, 186, 5, 43, "Input"],
Cell[47450, 1029, 164, 4, 43, "Input"],
Cell[47617, 1035, 186, 5, 43, "Input"],
Cell[47806, 1042, 103, 2, 27, "Input"],

Cell[CellGroupData[{
Cell[47934, 1048, 52, 1, 27, "Input"],
Cell[47989, 1051, 4914, 65, 1091, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[52940, 1121, 40, 0, 46, "Subsection"],

Cell[CellGroupData[{
Cell[53005, 1125, 45, 0, 42, "Subsubsection"],

Cell[CellGroupData[{
Cell[53075, 1129, 69, 1, 27, "Input"],
Cell[53147, 1132, 104, 2, 26, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[53288, 1139, 69, 1, 27, "Input"],
Cell[53360, 1142, 218, 3, 41, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[53615, 1150, 69, 1, 27, "Input"],
Cell[53687, 1153, 223, 3, 41, "Output"]
}, Open  ]],

Cell[CellGroupData[{
Cell[53947, 1161, 1356, 22, 331, "Input"],
Cell[55306, 1185, 47, 1, 26, "Output"]
}, Open  ]],
Cell[55368, 1189, 26, 0, 27, "Input"]
}, Open  ]]
}, Open  ]]
}, Open  ]]
}, Open  ]]
}
]
*)




(***********************************************************************
End of Mathematica Notebook file.
***********************************************************************)