Better Kinect Script.nb

(* Content-type: application/vnd.wolfram.mathematica *)

(*** Wolfram Notebook File ***)
(* http://www.wolfram.com/nb *)

(* CreatedBy='Mathematica 8.0' *)

(*CacheID: 234*)
(* Internal cache information:
NotebookFileLineBreakTest
NotebookFileLineBreakTest
NotebookDataPosition[       157,          7]
NotebookDataLength[     60768,       1484]
NotebookOptionsPosition[     59627,       1445]
NotebookOutlinePosition[     59971,       1460]
CellTagsIndexPosition[     59928,       1457]
WindowFrame->Normal*)

(* Beginning of Notebook Content *)
Notebook[{

Cell[CellGroupData[{
Cell[BoxData[{
 RowBox[{"tipPositionMeasuresCamera0", "=", 
  RowBox[{"{", "\[IndentingNewLine]", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{".17568", ",", " ", ".0816", ",", " ", "1.008"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{".192895", ",", " ", ".143966", ",", " ", ".988"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{".0954", ",", " ", ".0482", ",", " ", "1.033"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{
      RowBox[{"-", ".0135"}], ",", " ", 
      RowBox[{"-", ".0135"}], ",", " ", "1.091"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{
      RowBox[{"-", ".1002"}], ",", ".0923", ",", " ", "1.042"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{".05217", ",", " ", 
      RowBox[{"-", ".044"}], ",", " ", "1.074"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{
      RowBox[{"-", ".07979"}], ",", " ", 
      RowBox[{"-", ".01969"}], ",", " ", "1.088"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{
      RowBox[{"-", ".16723"}], ",", ".0505", ",", " ", "1.039"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{".1665", ",", " ", 
      RowBox[{"-", ".0794"}], ",", " ", "1.142"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{
      RowBox[{"-", ".1209"}], ",", " ", ".1246", ",", " ", ".969"}], "}"}], 
    ",", "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{".00297", ",", " ", ".0307", ",", "1.039"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{"{", 
     RowBox[{".2276", ",", " ", 
      RowBox[{"-", ".0281"}], ",", " ", "1.091"}], "}"}]}], 
   "\[IndentingNewLine]", "}"}]}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"tipPoseMeasuresBase0", " ", "=", " ", 
   RowBox[{"{", "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
      "0.116130888233", ",", "0.62813242215", ",", "0.199058084714", ",", 
       "0.114585242929", ",", "0.234195155498", ",", "0.959487058331", ",", 
       "0.10680559976"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
      "0.131115492705", ",", "0.561569002954", ",", "0.215122151934", ",", 
       "0.131532374977", ",", "0.177022749829", ",", "0.964096350108", ",", 
       "0.147920276107"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
      "0.135955781347", ",", "0.694457809531", ",", "0.094064842219", ",", 
       "0.330567996849", ",", "0.318802029836", ",", "0.887353318166", ",", 
       RowBox[{"-", "0.0411601016986"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.120480792967", ",", "0.795239241023", ",", 
       RowBox[{"-", "0.0772084253491"}], ",", "0.363732659491", ",", 
       "0.569030753532", ",", "0.716048535698", ",", 
       RowBox[{"-", "0.176570236672"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.132712257669", ",", "0.657463855982", ",", 
       RowBox[{"-", "0.15074305211"}], ",", "0.454183174351", ",", 
       "0.642105304789", ",", "0.609179254374", ",", 
       RowBox[{"-", "0.101582763001"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.0842867134246", ",", "0.823188008731", ",", 
       RowBox[{"-", "0.018549411128"}], ",", "0.354894518547", ",", 
       "0.523898133098", ",", "0.730164276656", ",", 
       RowBox[{"-", "0.257761044259"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.0763504219968", ",", "0.793359542239", ",", 
       RowBox[{"-", "0.15898399125"}], ",", "0.497822683899", ",", 
       "0.553198434161", ",", "0.607939972579", ",", 
       RowBox[{"-", "0.276682232134"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.0772274936894", ",", "0.686600837874", ",", 
       RowBox[{"-", "0.229024681889"}], ",", "0.534111233321", ",", 
       "0.635641349079", ",", "0.520515974633", ",", 
       RowBox[{"-", "0.199369972497"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
      "0.0735674867132", ",", "0.926555305813", ",", "0.0635573210911", ",", 
       "0.390421298414", ",", "0.348254346437", ",", "0.744359028596", ",", 
       RowBox[{"-", "0.414993682458"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.0763234432543", ",", "0.576980366275", ",", 
       RowBox[{"-", "0.172672084168"}], ",", "0.541989784963", ",", 
       "0.654849216522", ",", "0.495437087057", ",", 
       RowBox[{"-", "0.178778268773"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.0752154801954", ",", "0.730355988973", ",", 
       RowBox[{"-", "0.0750212788026"}], ",", "0.490997914803", ",", 
       "0.537901832738", ",", "0.621125023912", ",", 
       RowBox[{"-", "0.289458754689"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
      "0.0728714080455", ",", "0.847598256692", ",", "0.131878917238", ",", 
       "0.391310891614", ",", "0.348779288781", ",", "0.743767799896", ",", 
       RowBox[{"-", "0.414774943384"}]}], "}"}]}], "\[IndentingNewLine]", 
    "}"}]}], "\[IndentingNewLine]", "\[IndentingNewLine]", 
  RowBox[{"(*", " ", 
   RowBox[{"Original", " ", "Set", " ", "of", " ", "Points"}], " ", 
   "*)"}]}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"tipPositionMeasuresCamera1", " ", "=", 
    RowBox[{"{", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".00589333"}], ",", 
        RowBox[{"-", ".105238"}], ",", ".884"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".106757"}], ",", 
        RowBox[{"-", ".135529"}], ",", ".795"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".148386"}], ",", 
        RowBox[{"-", ".0966086"}], ",", ".663"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".0165571", ",", 
        RowBox[{"-", ".206529"}], ",", ".915"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".28152"}], ",", 
        RowBox[{"-", ".15883"}], ",", ".644"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".05232"}], ",", 
        RowBox[{"-", ".19632"}], ",", ".504"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".0516181"}], ",", ".0404238", ",", ".653"}], "}"}], ",",
       "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".0999429", ",", 
        RowBox[{"-", ".0446286"}], ",", ".66"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".1995"}], ",", 
        RowBox[{"-", ".0449667"}], ",", ".665"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".190593"}], ",", 
        RowBox[{"-", ".0896467"}], ",", ".791"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".0373019"}], ",", " ", 
        RowBox[{"-", ".130205"}], ",", " ", ".739"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".106058"}], ",", " ", 
        RowBox[{"-", ".10386"}], ",", " ", ".577"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".0511238", ",", " ", 
        RowBox[{"-", ".0997333"}], ",", " ", ".88"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".199133", ",", " ", ".0225619", ",", " ", "1.03"}], "}"}], 
      ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".114091"}], ",", "0.0313943", ",", " ", ".804"}], "}"}],
       ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".245151"}], ",", " ", ".10233", ",", ".773"}], "}"}], 
      ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".021738`"}], ",", " ", 
        RowBox[{"-", ".124342"}], ",", " ", ".913"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".0276857", ",", " ", 
        RowBox[{"-", ".119971"}], ",", " ", ".51"}], "}"}]}], "}"}]}], ";"}], 
  "\[IndentingNewLine]", 
  RowBox[{"(*", 
   RowBox[{"Table", " ", "ROI"}], "*)"}]}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"tipPositionMeasuresCamera2", "=", 
    RowBox[{"{", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".178817"}], ",", " ", 
        RowBox[{"-", ".0439714"}], ",", " ", "1.026"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".03388"}], ",", "  ", 
        RowBox[{"-", ".0359333"}], ",", " ", "1.078"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".153841", ",", " ", ".144403", ",", " ", ".991"}], "}"}], ",",
       "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".0129714", ",", " ", ".166899", ",", " ", ".908"}], "}"}], 
      ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".3032337"}], ",", " ", ".0116629", ",", " ", ".942"}], 
       "}"}], ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".0911733"}], ",", " ", 
        RowBox[{"-", ".011021"}], ",", " ", "1.052"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".129903", ",", " ", ".0276171", ",", " ", "1.074"}], "}"}], 
      ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{".253366", ",", " ", ".22159", ",", " ", ".878"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".11131"}], ",", " ", ".132681", ",", " ", ".935"}], 
       "}"}], ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".119674"}], ",", " ", ".0255713", ",", " ", "1.074"}], 
       "}"}], ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".10496"}], ",", " ", ".18688", ",", " ", ".896"}], 
       "}"}], ",", "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", ".440423"}], ",", " ", ".151554", ",", "1.068"}], 
       "}"}]}], "\[IndentingNewLine]", "}"}]}], ";"}], "\[IndentingNewLine]", 
  RowBox[{"(*", 
   RowBox[{"Original", " ", "Set"}], "*)"}]}], "\n", 
 RowBox[{
  RowBox[{
   RowBox[{"tipPoseMeasuresBase1", "=", 
    RowBox[{"{", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.173710009233"}], ",", "0.760949904263", ",", 
        RowBox[{"-", "0.0414285782109"}], ",", "0.335226766202", ",", 
        RowBox[{"-", "0.45570273846"}], ",", 
        RowBox[{"-", "0.241904076767"}], ",", "0.788314941521"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.288958720129"}], ",", "0.700358913003", ",", 
        RowBox[{"-", "0.121111281065"}], ",", "0.481918747145", ",", 
        RowBox[{"-", "0.43043303822"}], ",", 
        RowBox[{"-", "0.244714549583"}], ",", "0.722908369007"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.347604340239"}], ",", "0.560205673841", ",", 
        RowBox[{"-", "0.147369898951"}], ",", 
        RowBox[{"-", "0.483790509828"}], ",", "0.172250652291", ",", 
        "0.838753609369", ",", 
        RowBox[{"-", "0.181021651072"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.240428311233"}], ",", "0.835623713522", ",", 
        RowBox[{"-", "0.0133620335141"}], ",", 
        RowBox[{"-", "0.429377342167"}], ",", 
        RowBox[{"-", "0.0388460535754"}], ",", "0.843729546228", ",", 
        "0.319760120992"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.410240877709"}], ",", "0.599080645978", ",", 
        RowBox[{"-", "0.303092055807"}], ",", 
        RowBox[{"-", "0.523713969601"}], ",", "0.0992629903729", ",", 
        "0.846076310628", ",", "0.0050411686481"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.543626879476"}], ",", "0.528934887194", ",", 
        RowBox[{"-", "0.0554267349127"}], ",", 
        RowBox[{"-", "0.274524890196"}], ",", "0.107829892343", ",", 
        "0.951107921328", ",", 
        RowBox[{"-", "0.0916652658756"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.316020131138"}], ",", "0.528929787384", ",", 
        RowBox[{"-", "0.0554174240904"}], ",", 
        RowBox[{"-", "0.274463093248"}], ",", "0.107848042338", ",", 
        "0.951123050324", ",", 
        RowBox[{"-", "0.0916719878232"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.315462788393"}], ",", "0.528899873034", ",", 
        "0.098160425308", ",", 
        RowBox[{"-", "0.274509369404"}], ",", "0.107797787434", ",", 
        "0.951114217006", ",", 
        RowBox[{"-", "0.0916841826234"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.315453854967"}], ",", "0.52891580984", ",", 
        RowBox[{"-", "0.206435347579"}], ",", 
        RowBox[{"-", "0.274490628161"}], ",", "0.107782025573", ",", 
        "0.951123763818", ",", 
        RowBox[{"-", "0.091659783531"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.253342199365"}], ",", "0.659555571389", ",", 
        RowBox[{"-", "0.210860028876"}], ",", 
        RowBox[{"-", "0.299887073145"}], ",", "0.117162179122", ",", 
        "0.942369376492", ",", 
        RowBox[{"-", "0.0909984911603"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.327059080669"}], ",", "0.658755406583", ",", 
        RowBox[{"-", "0.0477930632972"}], ",", 
        RowBox[{"-", "0.0326227175062"}], ",", "0.0887463122844", ",", 
        "0.988195439308", ",", 
        RowBox[{"-", "0.120538890359"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.424048772605"}], ",", "0.520150963581", ",", 
        RowBox[{"-", "0.111609740756"}], ",", 
        RowBox[{"-", "0.0335514824158"}], ",", "0.185310203524", ",", 
        "0.941692009707", ",", 
        RowBox[{"-", "0.2788379195"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.202540329292"}], ",", "0.740626155296", ",", 
        "0.0341568162735", ",", 
        RowBox[{"-", "0.0307296883994"}], ",", 
        RowBox[{"-", "0.00500846850381"}], ",", "0.998990105568", ",", 
        "0.0323939881955"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.020903206473"}], ",", "0.75721496274", ",", 
        "0.178732534453", ",", "0.0759001689361", ",", 
        RowBox[{"-", "0.131783867835"}], ",", "0.527853565227", ",", 
        "0.835609232962"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.146148533568"}], ",", "0.575230933801", ",", 
        RowBox[{"-", "0.122410771215"}], ",", 
        RowBox[{"-", "0.571046037771"}], ",", 
        RowBox[{"-", "0.177462252765"}], ",", "0.665282260011", ",", 
        "0.447004570562"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.130606431655"}], ",", "0.494339873318", ",", 
        RowBox[{"-", "0.242678929438"}], ",", 
        RowBox[{"-", "0.666187657761"}], ",", "0.00449715450427", ",", 
        "0.67439825079", ",", "0.318372077263"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.154780471624"}], ",", "0.789707123188", ",", 
        RowBox[{"-", "0.0566862418858"}], ",", 
        RowBox[{"-", "0.201364615819"}], ",", 
        RowBox[{"-", "0.565084530408"}], ",", "0.478224189978", ",", 
        "0.641430736019"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.490121657235"}], ",", "0.478773209211", ",", 
        "0.031886121069", ",", "0.0205764922825", ",", "0.146750154824", ",", 
        "0.8545004747", ",", "0.497865382168"}], "}"}]}], "}"}]}], ";"}], 
  "\[IndentingNewLine]", 
  RowBox[{"(*", " ", 
   RowBox[{"Points", " ", "in", " ", "table", " ", "ROI"}], " ", 
   "*)"}]}], "\n", 
 RowBox[{
  RowBox[{
   RowBox[{"tipPoseMeasuresBase2", "=", 
    RowBox[{"{", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.021143700747"}], ",", "0.808501737553", ",", 
        RowBox[{"-", "0.124783317853"}], ",", 
        RowBox[{"-", "0.0671563746256"}], ",", "0.346332409918", ",", 
        "0.622827712688", ",", "0.69830474973"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
       "0.0207677628396", ",", "0.822964467887", ",", "0.0192071400059", ",", 
        "0.0421735268297", ",", "0.261406393394", ",", "0.635985352963", ",", 
        "0.724852206966"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
       "0.0674034733686", ",", "0.612862465899", ",", "0.178956511413", ",", 
        "0.3045689777", ",", "0.0309815476564", ",", "0.61351604821", ",", 
        "0.727925779264"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
       "0.0267219835483", ",", "0.54773684407", ",", "0.0395892310979", ",", 
        "0.189637532942", ",", "0.136545384873", ",", "0.633280989251", ",", 
        "0.737799534171"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.0664012677555"}], ",", "0.723529899496", ",", 
        RowBox[{"-", "0.252217867552"}], ",", 
        RowBox[{"-", "0.154307737436"}], ",", "0.426608314558", ",", 
        "0.60290895443", ",", "0.656273769692"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.00476496766125", ",", "0.794868702763", ",", 
        RowBox[{"-", "0.0325327017581"}], ",", "0.0307634001972", ",", 
        "0.288555587243", ",", "0.634096678094", ",", "0.716736136321"}], 
       "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
       "0.0731003576489", ",", "0.757753089238", ",", "0.178426217136", ",", 
        "0.201329280031", ",", "0.145133724977", ",", "0.63015946576", ",", 
        "0.735732132362"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
       "0.0286686369398", ",", "0.467459347932", ",", "0.259480348094", ",", 
        "0.396674943812", ",", 
        RowBox[{"-", "0.206432836328"}], ",", "0.604335764808", ",", 
        "0.659403333637"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.0107607498571", ",", "0.597507097916", ",", 
        RowBox[{"-", "0.0704614925341"}], ",", 
        RowBox[{"-", "0.03662271629"}], ",", "0.181288053375", ",", 
        "0.635622886585", ",", "0.749517821272"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.0107634867394", ",", "0.81945589221", ",", 
        RowBox[{"-", "0.07045406949"}], ",", 
        RowBox[{"-", "0.0366027212284"}], ",", "0.181258571872", ",", 
        "0.635639327082", ",", "0.749511985753"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.0107613421837", ",", "0.533843854518", ",", 
        RowBox[{"-", "0.0704421303438"}], ",", 
        RowBox[{"-", "0.0366189733354"}], ",", "0.181255521181", ",", 
        "0.635649948156", ",", "0.749502922104"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.113208193536", ",", "0.641358700049", ",", 
        RowBox[{"-", "0.458897399466"}], ",", "0.5742003091", ",", 
        "0.65857800889", ",", "0.285229077505", ",", "0.393971299185"}], 
       "}"}]}], "\[IndentingNewLine]", "}"}]}], ";"}], 
  "\[IndentingNewLine]"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"tipPoseMeasuresBase", " ", "=", " ", 
   RowBox[{"Join", "[", 
    RowBox[{
    "tipPoseMeasuresBase0", ",", " ", "tipPoseMeasuresBase1", ",", " ", 
     "tipPoseMeasuresBase2"}], "]"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"tipPositionMeasuresCamera", " ", "=", " ", 
   RowBox[{"Join", "[", 
    RowBox[{
    "tipPositionMeasuresCamera0", ",", " ", "tipPositionMeasuresCamera1", ",",
      " ", "tipPositionMeasuresCamera2"}], "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"qx", ":=", 
   RowBox[{
    RowBox[{"tipPoseBase", "[", 
     RowBox[{"[", "4", "]"}], "]"}], "/", 
    RowBox[{"Norm", "[", 
     RowBox[{"tipPoseBase", "[", 
      RowBox[{"[", 
       RowBox[{"4", ";;", "7"}], "]"}], "]"}], "]"}]}]}], ";"}], "\n", 
 RowBox[{
  RowBox[{"qy", ":=", 
   RowBox[{
    RowBox[{"tipPoseBase", "[", 
     RowBox[{"[", "5", "]"}], "]"}], "/", 
    RowBox[{"Norm", "[", 
     RowBox[{"tipPoseBase", "[", 
      RowBox[{"[", 
       RowBox[{"4", ";;", "7"}], "]"}], "]"}], "]"}]}]}], ";"}], "\n", 
 RowBox[{
  RowBox[{"qz", ":=", 
   RowBox[{
    RowBox[{"tipPoseBase", "[", 
     RowBox[{"[", "6", "]"}], "]"}], "/", 
    RowBox[{"Norm", "[", 
     RowBox[{"tipPoseBase", "[", 
      RowBox[{"[", 
       RowBox[{"4", ";;", "7"}], "]"}], "]"}], "]"}]}]}], ";"}], "\n", 
 RowBox[{
  RowBox[{"qw", ":=", 
   RowBox[{
    RowBox[{"tipPoseBase", "[", 
     RowBox[{"[", "7", "]"}], "]"}], "/", 
    RowBox[{"Norm", "[", 
     RowBox[{"tipPoseBase", "[", 
      RowBox[{"[", 
       RowBox[{"4", ";;", "7"}], "]"}], "]"}], "]"}]}]}], ";"}], "\n", 
 RowBox[{
  RowBox[{"tipTFBase", ":=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
       RowBox[{"1", "-", 
        RowBox[{"2", "*", 
         RowBox[{"qy", "^", "2"}]}], "-", 
        RowBox[{"2", "*", 
         RowBox[{"qz", "^", "2"}]}]}], ",", 
       RowBox[{
        RowBox[{"2", " ", "qx", "*", "qy"}], "+", 
        RowBox[{"2", " ", "qw", "*", "qz"}]}], ",", 
       RowBox[{
        RowBox[{"2", " ", "qx", "*", "qz"}], "-", 
        RowBox[{"2", " ", "qw", "*", "qy"}]}], ",", 
       RowBox[{"tipPoseBase", "[", 
        RowBox[{"[", "1", "]"}], "]"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{
        RowBox[{"2", "*", "qx", "*", "qy"}], "-", 
        RowBox[{"2", " ", "qw", "*", "qz"}]}], ",", 
       RowBox[{"1", "-", 
        RowBox[{"2", " ", 
         RowBox[{"qx", "^", "2"}]}], "-", 
        RowBox[{"2", " ", 
         RowBox[{"qz", "^", "2"}]}]}], ",", 
       RowBox[{
        RowBox[{"2", " ", "qy", "*", "qz"}], "+", 
        RowBox[{"2", " ", "qw", "*", "qx"}]}], ",", 
       RowBox[{"tipPoseBase", "[", 
        RowBox[{"[", "2", "]"}], "]"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{
        RowBox[{"2", " ", "qx", "*", "qz"}], "+", 
        RowBox[{"2", " ", "qw", "*", "qy"}]}], ",", 
       RowBox[{
        RowBox[{"2", "*", "qy", "*", "qz"}], "-", 
        RowBox[{"2", " ", "qw", "*", "qx"}]}], ",", 
       RowBox[{"1", "-", 
        RowBox[{"2", " ", 
         RowBox[{"qx", "^", "2"}]}], "-", 
        RowBox[{"2", " ", 
         RowBox[{"qy", "^", "2"}]}]}], ",", 
       RowBox[{"tipPoseBase", "[", 
        RowBox[{"[", "3", "]"}], "]"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0", ",", "0", ",", "0", ",", "1"}], "}"}]}], "}"}]}], 
  ";"}], "\n", 
 RowBox[{
  RowBox[{"baseTFCamera", ":=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
       RowBox[{"1", "-", 
        RowBox[{"2", "*", 
         RowBox[{"baseQYCamera", "^", "2"}]}], "-", 
        RowBox[{"2", "*", 
         RowBox[{"baseQZCamera", "^", "2"}]}]}], ",", 
       RowBox[{
        RowBox[{"2", " ", "baseQXCamera", "*", "baseQYCamera"}], "+", 
        RowBox[{"2", " ", "baseQWCamera", "*", "baseQZCamera"}]}], ",", 
       RowBox[{
        RowBox[{"2", " ", "baseQXCamera", "*", "baseQZCamera"}], "-", 
        RowBox[{"2", " ", "baseQWCamera", "*", "baseQYCamera"}]}], ",", 
       "baseXCamera"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{
        RowBox[{"2", "*", "baseQXCamera", "*", "baseQYCamera"}], "-", 
        RowBox[{"2", " ", "baseQWCamera", "*", "baseQZCamera"}]}], ",", 
       RowBox[{"1", "-", 
        RowBox[{"2", " ", 
         RowBox[{"baseQXCamera", "^", "2"}]}], "-", 
        RowBox[{"2", " ", 
         RowBox[{"baseQZCamera", "^", "2"}]}]}], ",", 
       RowBox[{
        RowBox[{"2", " ", "baseQYCamera", "*", "baseQZCamera"}], "+", 
        RowBox[{"2", " ", "baseQWCamera", "*", "baseQXCamera"}]}], ",", 
       "baseYCamera"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{
        RowBox[{"2", " ", "baseQXCamera", "*", "baseQZCamera"}], "+", 
        RowBox[{"2", " ", "baseQWCamera", "*", "baseQYCamera"}]}], ",", 
       RowBox[{
        RowBox[{"2", "*", "baseQYCamera", "*", "baseQZCamera"}], "-", 
        RowBox[{"2", " ", "baseQWCamera", "*", "baseQXCamera"}]}], ",", 
       RowBox[{"1", "-", 
        RowBox[{"2", " ", 
         RowBox[{"baseQXCamera", "^", "2"}]}], "-", 
        RowBox[{"2", " ", 
         RowBox[{"baseQYCamera", "^", "2"}]}]}], ",", "baseZCamera"}], "}"}], 
     ",", "\[IndentingNewLine]", 
     RowBox[{"{", 
      RowBox[{"0", ",", "0", ",", "0", ",", "1"}], "}"}]}], "}"}]}], 
  ";"}], "\n", 
 RowBox[{
  RowBox[{"tipTFCamera", ":=", 
   RowBox[{"baseTFCamera", ".", "tipTFBase"}]}], ";"}], "\n", 
 RowBox[{"tipPositionsCamera", ":=", 
  RowBox[{"Table", "[", 
   RowBox[{
    RowBox[{"tipTFCamera", "[", 
     RowBox[{"[", 
      RowBox[{
       RowBox[{"1", ";;", "3"}], ",", "4"}], "]"}], "]"}], ",", 
    RowBox[{"{", 
     RowBox[{"tipPoseBase", ",", "tipPoseMeasuresBase"}], "}"}]}], 
   "]"}]}], "\n", 
 RowBox[{
  RowBox[{"test", " ", "=", " ", 
   RowBox[{"Minimize", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
       RowBox[{"RootMeanSquare", "[", 
        RowBox[{"Flatten", "[", 
         RowBox[{"tipPositionMeasuresCamera", "-", "tipPositionsCamera"}], 
         "]"}], "]"}], ",", 
       RowBox[{
        RowBox[{"Norm", "[", 
         RowBox[{"{", 
          RowBox[{
          "baseQXCamera", ",", "baseQYCamera", ",", "baseQZCamera", ",", 
           "baseQWCamera"}], "}"}], "]"}], "\[Equal]", "1"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
      "baseQXCamera", ",", "baseQYCamera", ",", "baseQZCamera", ",", 
       "baseQWCamera", ",", "baseXCamera", ",", "baseYCamera", ",", 
       "baseZCamera"}], "}"}], ",", " ", "Reals"}], "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"rms", " ", "=", " ", 
   RowBox[{"test", "[", 
    RowBox[{"[", "1", "]"}], "]"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{"StringJoin", "[", 
  RowBox[{
   RowBox[{"ToString", "[", 
    RowBox[{
     RowBox[{
      RowBox[{"test", "[", 
       RowBox[{"[", "2", "]"}], "]"}], "[", 
      RowBox[{"[", "5", "]"}], "]"}], "[", 
     RowBox[{"[", "2", "]"}], "]"}], "]"}], ",", "\"\< \>\"", ",", 
   RowBox[{"ToString", "[", 
    RowBox[{
     RowBox[{
      RowBox[{"test", "[", 
       RowBox[{"[", "2", "]"}], "]"}], "[", 
      RowBox[{"[", "6", "]"}], "]"}], "[", 
     RowBox[{"[", "2", "]"}], "]"}], "]"}], ",", "\"\< \>\"", ",", 
   RowBox[{"ToString", "[", 
    RowBox[{
     RowBox[{
      RowBox[{"test", "[", 
       RowBox[{"[", "2", "]"}], "]"}], "[", 
      RowBox[{"[", "7", "]"}], "]"}], "[", 
     RowBox[{"[", "2", "]"}], "]"}], "]"}], ",", "\"\< \>\"", ",", 
   RowBox[{"ToString", "[", " ", 
    RowBox[{
     RowBox[{
      RowBox[{"test", "[", 
       RowBox[{"[", "2", "]"}], "]"}], "[", 
      RowBox[{"[", "1", "]"}], "]"}], "[", 
     RowBox[{"[", "2", "]"}], "]"}], "]"}], ",", "\"\< \>\"", ",", 
   RowBox[{"ToString", "[", " ", 
    RowBox[{
     RowBox[{
      RowBox[{"test", "[", 
       RowBox[{"[", "2", "]"}], "]"}], "[", 
      RowBox[{"[", "2", "]"}], "]"}], "[", 
     RowBox[{"[", "2", "]"}], "]"}], "]"}], ",", "\"\< \>\"", ",", 
   RowBox[{"ToString", "[", 
    RowBox[{
     RowBox[{
      RowBox[{"test", "[", 
       RowBox[{"[", "2", "]"}], "]"}], "[", 
      RowBox[{"[", "3", "]"}], "]"}], "[", 
     RowBox[{"[", "2", "]"}], "]"}], "]"}], ",", "\"\< \>\"", ",", 
   RowBox[{"ToString", "[", " ", 
    RowBox[{"-", 
     RowBox[{
      RowBox[{
       RowBox[{"test", "[", 
        RowBox[{"[", "2", "]"}], "]"}], "[", 
       RowBox[{"[", "4", "]"}], "]"}], "[", 
      RowBox[{"[", "2", "]"}], "]"}]}], "]"}]}], "]"}]}], "Input",
 CellChangeTimes->{{3.572866232978609*^9, 3.572866264217396*^9}, {
   3.572866664265277*^9, 3.5728666643872843`*^9}, {3.572866781540985*^9, 
   3.572866863908696*^9}, {3.572866935449788*^9, 3.572866939629027*^9}, {
   3.572867027136032*^9, 3.572867086425423*^9}, {3.5728671574134836`*^9, 
   3.5728674479270997`*^9}, {3.5728674885094213`*^9, 3.57286766507152*^9}, {
   3.572867700266533*^9, 3.572867704148755*^9}, {3.5728677353985424`*^9, 
   3.5728678024593782`*^9}, {3.5728679202761164`*^9, 3.572867921173168*^9}, {
   3.572867986409899*^9, 3.5728680152625494`*^9}, 3.5728684991702275`*^9, {
   3.5728687828774548`*^9, 3.5728688223187103`*^9}, {3.5728688556126146`*^9, 
   3.572868857503723*^9}, {3.5728690669197006`*^9, 3.572869071720976*^9}, {
   3.572869216508257*^9, 3.5728692898284507`*^9}, {3.572869368091927*^9, 
   3.57286939227131*^9}, 3.572869428057357*^9, {3.572869512837206*^9, 
   3.572869547303177*^9}, {3.572870278314989*^9, 3.5728704126136703`*^9}, {
   3.572870450454835*^9, 3.5728706323062363`*^9}, {3.572870682574111*^9, 
   3.5728708013459044`*^9}, 3.5728709636971903`*^9, 3.5728710377384253`*^9, {
   3.5728710685321865`*^9, 3.5728711511729136`*^9}, {3.5728714795150304`*^9, 
   3.572871555476375*^9}, 3.572871659379318*^9, {3.572871718631707*^9, 
   3.57287178372343*^9}, {3.572871817625369*^9, 3.572871819968503*^9}, {
   3.5728718717004623`*^9, 3.5728718766877475`*^9}, {3.5728719201622343`*^9, 
   3.5728719442896137`*^9}, {3.5728720135675764`*^9, 
   3.5728720285054307`*^9}, {3.5728783666538014`*^9, 3.572878371057053*^9}, {
   3.5728784602051525`*^9, 3.5728784808413324`*^9}, {3.572878536025489*^9, 
   3.5728785481501827`*^9}, {3.5728786515430965`*^9, 
   3.5728786725562983`*^9}, {3.5728787030200405`*^9, 3.572878720937065*^9}, 
   3.5728787542619715`*^9, {3.572878802750745*^9, 3.5728788214578147`*^9}, {
   3.572878887233577*^9, 3.5728789072777233`*^9}, {3.5728789876983232`*^9, 
   3.5728790051893234`*^9}, {3.572879045763644*^9, 3.5728790739532566`*^9}, {
   3.5728792495052977`*^9, 3.5728792564086924`*^9}, {3.5728793293838663`*^9, 
   3.5728793457058*^9}, {3.5728793783706684`*^9, 3.57287939169143*^9}, {
   3.572879432818783*^9, 3.5728795028347874`*^9}, {3.5728795413879924`*^9, 
   3.572879555647808*^9}, {3.572879595035061*^9, 3.5728796147321873`*^9}, {
   3.572879652079324*^9, 3.5728796662751355`*^9}, {3.572879703871286*^9, 
   3.572879715258937*^9}, {3.5728797571013308`*^9, 3.572879773385262*^9}, {
   3.572879884258603*^9, 3.5728798868807535`*^9}, {3.572879960447961*^9, 
   3.5728799720496244`*^9}, {3.572880009045741*^9, 3.5728800145450554`*^9}, {
   3.572880067728097*^9, 3.572880073355419*^9}, {3.572880191886199*^9, 
   3.572880193968318*^9}, {3.572880245823284*^9, 3.572880255616844*^9}, {
   3.572880328872034*^9, 3.5728803339613247`*^9}, {3.5728808072423954`*^9, 
   3.57288083513599*^9}, {3.5728808703930073`*^9, 3.5728809111963406`*^9}, {
   3.572881474339551*^9, 3.5728815500058784`*^9}, {3.572882730198986*^9, 
   3.5728827899224024`*^9}, {3.5728828261744757`*^9, 
   3.5728828285906143`*^9}, {3.5728901988010798`*^9, 3.572890223749507*^9}, {
   3.5728904475123053`*^9, 3.5728904643332677`*^9}, {3.572890708819251*^9, 
   3.5728907343147097`*^9}, {3.5728907812593946`*^9, 
   3.5728908009385204`*^9}, {3.5728908387186813`*^9, 3.572890853222511*^9}, {
   3.572890894961898*^9, 3.5728909158700943`*^9}, {3.5728909723473244`*^9, 
   3.5728909910243926`*^9}, {3.5728910700139103`*^9, 
   3.5728910875709147`*^9}, {3.572891136953739*^9, 3.572891152542631*^9}, {
   3.572891202599494*^9, 3.5728912199444857`*^9}, 3.5728913022261925`*^9, {
   3.572891965561133*^9, 3.572891989404497*^9}, {3.572892061283608*^9, 
   3.572892064781808*^9}, 3.5728921485395985`*^9, {3.5728924006480184`*^9, 
   3.572892443144449*^9}, {3.5728925318255215`*^9, 3.5728925778441534`*^9}, {
   3.5728926157623224`*^9, 3.5728926407697525`*^9}, 3.572892765788903*^9, {
   3.572892839369112*^9, 3.572892846275507*^9}, {3.5728931014961047`*^9, 
   3.5728931194771333`*^9}, 3.572893376029807*^9, 3.572893619722746*^9, 
   3.5728937700803456`*^9, 3.572893813182811*^9, {3.5728938684579725`*^9, 
   3.572893872296192*^9}, {3.5728941482839775`*^9, 3.57289415321826*^9}, {
   3.5728943388128753`*^9, 3.5728943819143405`*^9}, 3.5728947592049203`*^9, {
   3.5728949793215103`*^9, 3.572894984352798*^9}, {3.572895407271988*^9, 
   3.5728954121832685`*^9}, {3.572896237491473*^9, 3.572896240249631*^9}, {
   3.5728962925306215`*^9, 3.5728963162899804`*^9}, {3.572896380990681*^9, 
   3.5728963949604797`*^9}, {3.57289642730333*^9, 3.5728964483795357`*^9}, {
   3.572896554302594*^9, 3.572896569057438*^9}, {3.5728966452237945`*^9, 
   3.5728966799947834`*^9}, {3.5728967259644127`*^9, 
   3.5728967452185135`*^9}, {3.5728968172756352`*^9, 
   3.5728968371357713`*^9}, {3.5728969184774237`*^9, 
   3.5728969435978603`*^9}, {3.5728970322639318`*^9, 3.572897046083722*^9}, 
   3.5728970947275047`*^9, 3.572898071193355*^9, {3.573048352537252*^9, 
   3.57304844393748*^9}, {3.5730485906018686`*^9, 3.573048626102899*^9}, {
   3.5730487165680733`*^9, 3.5730487345781035`*^9}, {3.573048807755289*^9, 
   3.573048827774434*^9}, {3.573048898318469*^9, 3.573048921431791*^9}, {
   3.5730490465579476`*^9, 3.5730490661290674`*^9}, {3.5730497717154245`*^9, 
   3.5730497752196245`*^9}, {3.573049920731948*^9, 3.5730499429722195`*^9}, {
   3.5730501958846855`*^9, 3.5730502501937914`*^9}, {3.5730502849647803`*^9, 
   3.5730502856058173`*^9}, {3.573050322391921*^9, 3.57305033809682*^9}, {
   3.573050374000873*^9, 3.5730503766580253`*^9}, {3.5730527895740356`*^9, 
   3.5730528049889174`*^9}, {3.573052865026352*^9, 3.573052888274681*^9}, {
   3.573052974608619*^9, 3.5730530170610476`*^9}, {3.5730531403140974`*^9, 
   3.573053141202148*^9}, {3.5730536258628693`*^9, 3.5730536332542915`*^9}, {
   3.573053922823854*^9, 3.573053928684189*^9}, {3.5730539649852657`*^9, 
   3.5730539867605114`*^9}, {3.573054034682252*^9, 3.573054074694541*^9}, {
   3.57305467593993*^9, 3.573054677792036*^9}, {3.573056228223716*^9, 
   3.573056228530733*^9}, {3.573056395542286*^9, 3.5730564057518697`*^9}, {
   3.5730564572958174`*^9, 3.5730564732887325`*^9}, {3.573056511117896*^9, 
   3.5730565173142505`*^9}, {3.573056573150444*^9, 3.5730565930135803`*^9}, {
   3.573056633496896*^9, 3.5730566764333515`*^9}, {3.5730576330780687`*^9, 
   3.573057641157531*^9}, {3.5730577276934805`*^9, 3.5730577557750864`*^9}, {
   3.5730578332955203`*^9, 3.5730578354146414`*^9}, {3.573058012463768*^9, 
   3.5730580181180916`*^9}, {3.5730581487765646`*^9, 3.5730581625643535`*^9}, 
   3.5730582476192183`*^9, {3.573060205683213*^9, 3.57306021506575*^9}, {
   3.5730603720857306`*^9, 3.5730604163972654`*^9}, {3.5730609287705717`*^9, 
   3.573061029728346*^9}, {3.573061174769642*^9, 3.5730612308298483`*^9}, {
   3.57306129659161*^9, 3.573061299341767*^9}, 3.5730613318376255`*^9, 
   3.5730613628033967`*^9, {3.573385064484269*^9, 3.573385133167197*^9}, {
   3.5733888942793207`*^9, 3.5733889215848827`*^9}, {3.5733891588204517`*^9, 
   3.5733891610755806`*^9}, {3.5733893029516954`*^9, 
   3.5733893436150208`*^9}, {3.5733894132940063`*^9, 
   3.5733894250916815`*^9}, {3.573389466992078*^9, 3.573389478452733*^9}, {
   3.573776147921092*^9, 3.5737761592711077`*^9}, {3.5737762541392903`*^9, 
   3.5737763095373745`*^9}, {3.5737766118058043`*^9, 3.573776717415983*^9}}],

Cell[BoxData[
 RowBox[{"{", 
  RowBox[{
   RowBox[{"{", 
    RowBox[{"0.17568`", ",", "0.0816`", ",", "1.008`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.192895`", ",", "0.143966`", ",", "0.988`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.0954`", ",", "0.0482`", ",", "1.033`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"-", "0.0135`"}], ",", 
     RowBox[{"-", "0.0135`"}], ",", "1.091`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"-", "0.1002`"}], ",", "0.0923`", ",", "1.042`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.05217`", ",", 
     RowBox[{"-", "0.044`"}], ",", "1.074`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"-", "0.07979`"}], ",", 
     RowBox[{"-", "0.01969`"}], ",", "1.088`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"-", "0.16723`"}], ",", "0.0505`", ",", "1.039`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.1665`", ",", 
     RowBox[{"-", "0.0794`"}], ",", "1.142`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"-", "0.1209`"}], ",", "0.1246`", ",", "0.969`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.00297`", ",", "0.0307`", ",", "1.039`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.2276`", ",", 
     RowBox[{"-", "0.0281`"}], ",", "1.091`"}], "}"}]}], "}"}]], "Output",
 CellChangeTimes->{{3.5730610182566895`*^9, 3.5730610338465815`*^9}, {
   3.573061337007921*^9, 3.5730613668286266`*^9}, {3.573388896788464*^9, 
   3.5733889331395435`*^9}, 3.5733889918269*^9, 3.573389059386764*^9, 
   3.573389133866024*^9, 3.5733891971466436`*^9, {3.57338930356173*^9, 
   3.573389344703083*^9}, 3.573389425660714*^9, 3.5733894791577735`*^9, {
   3.573774904891737*^9, 3.573774919599777*^9}, 3.5737761599071093`*^9, 
   3.5737763101933765`*^9, 3.5737766433138485`*^9, 3.5737767183109846`*^9}],

Cell[BoxData[
 RowBox[{"{", 
  RowBox[{
   RowBox[{"{", 
    RowBox[{
    "0.116130888233`", ",", "0.62813242215`", ",", "0.199058084714`", ",", 
     "0.114585242929`", ",", "0.234195155498`", ",", "0.959487058331`", ",", 
     "0.10680559976`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
    "0.131115492705`", ",", "0.561569002954`", ",", "0.215122151934`", ",", 
     "0.131532374977`", ",", "0.177022749829`", ",", "0.964096350108`", ",", 
     "0.147920276107`"}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
    "0.135955781347`", ",", "0.694457809531`", ",", "0.094064842219`", ",", 
     "0.330567996849`", ",", "0.318802029836`", ",", "0.887353318166`", ",", 
     RowBox[{"-", "0.0411601016986`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.120480792967`", ",", "0.795239241023`", ",", 
     RowBox[{"-", "0.0772084253491`"}], ",", "0.363732659491`", ",", 
     "0.569030753532`", ",", "0.716048535698`", ",", 
     RowBox[{"-", "0.176570236672`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.132712257669`", ",", "0.657463855982`", ",", 
     RowBox[{"-", "0.15074305211`"}], ",", "0.454183174351`", ",", 
     "0.642105304789`", ",", "0.609179254374`", ",", 
     RowBox[{"-", "0.101582763001`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.0842867134246`", ",", "0.823188008731`", ",", 
     RowBox[{"-", "0.018549411128`"}], ",", "0.354894518547`", ",", 
     "0.523898133098`", ",", "0.730164276656`", ",", 
     RowBox[{"-", "0.257761044259`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.0763504219968`", ",", "0.793359542239`", ",", 
     RowBox[{"-", "0.15898399125`"}], ",", "0.497822683899`", ",", 
     "0.553198434161`", ",", "0.607939972579`", ",", 
     RowBox[{"-", "0.276682232134`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.0772274936894`", ",", "0.686600837874`", ",", 
     RowBox[{"-", "0.229024681889`"}], ",", "0.534111233321`", ",", 
     "0.635641349079`", ",", "0.520515974633`", ",", 
     RowBox[{"-", "0.199369972497`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
    "0.0735674867132`", ",", "0.926555305813`", ",", "0.0635573210911`", ",", 
     "0.390421298414`", ",", "0.348254346437`", ",", "0.744359028596`", ",", 
     RowBox[{"-", "0.414993682458`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.0763234432543`", ",", "0.576980366275`", ",", 
     RowBox[{"-", "0.172672084168`"}], ",", "0.541989784963`", ",", 
     "0.654849216522`", ",", "0.495437087057`", ",", 
     RowBox[{"-", "0.178778268773`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0.0752154801954`", ",", "0.730355988973`", ",", 
     RowBox[{"-", "0.0750212788026`"}], ",", "0.490997914803`", ",", 
     "0.537901832738`", ",", "0.621125023912`", ",", 
     RowBox[{"-", "0.289458754689`"}]}], "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
    "0.0728714080455`", ",", "0.847598256692`", ",", "0.131878917238`", ",", 
     "0.391310891614`", ",", "0.348779288781`", ",", "0.743767799896`", ",", 
     RowBox[{"-", "0.414774943384`"}]}], "}"}]}], "}"}]], "Output",
 CellChangeTimes->{{3.5730610182566895`*^9, 3.5730610338465815`*^9}, {
   3.573061337007921*^9, 3.5730613668286266`*^9}, {3.573388896788464*^9, 
   3.5733889331395435`*^9}, 3.5733889918269*^9, 3.573389059386764*^9, 
   3.573389133866024*^9, 3.5733891971466436`*^9, {3.57338930356173*^9, 
   3.573389344703083*^9}, 3.573389425660714*^9, 3.5733894791577735`*^9, {
   3.573774904891737*^9, 3.573774919599777*^9}, 3.5737761599071093`*^9, 
   3.5737763101933765`*^9, 3.5737766433138485`*^9, 3.5737767183229856`*^9}],

Cell[BoxData["\<\"-0.0178783 0.571916 0.54635 0.680858 0.248381 0.651141 \
0.225286\"\>"], "Output",
 CellChangeTimes->{{3.5730610182566895`*^9, 3.5730610338465815`*^9}, {
   3.573061337007921*^9, 3.5730613668286266`*^9}, {3.573388896788464*^9, 
   3.5733889331395435`*^9}, 3.5733889918269*^9, 3.573389059386764*^9, 
   3.573389133866024*^9, 3.5733891971466436`*^9, {3.57338930356173*^9, 
   3.573389344703083*^9}, 3.573389425660714*^9, 3.5733894791577735`*^9, {
   3.573774904891737*^9, 3.573774919599777*^9}, 3.5737761599071093`*^9, 
   3.5737763101933765`*^9, 3.5737766433138485`*^9, 3.573776721427995*^9}]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[{
 RowBox[{
  RowBox[{"baseQXCamera", "=", "0.6651111844349787`"}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"baseQYCamera", "=", "0.2855279940674658`"}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"baseQZCamera", "=", "0.6497915816019696`"}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"baseQWCamera", "=", 
   RowBox[{"-", "0.2321029542459286`"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"baseXCamera", "=", 
   RowBox[{"-", "0.03864276402208912`"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"baseYCamera", "=", "0.5724465822985199`"}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"baseZCamera", "=", "0.5233955714948171`"}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{"Normalize", "[", 
  RowBox[{"{", 
   RowBox[{
    RowBox[{
     RowBox[{"-", "baseQXCamera"}], " ", "/", " ", 
     RowBox[{"baseQWCamera", "^", "2"}]}], ",", "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"-", "baseQYCamera"}], " ", "/", " ", 
     RowBox[{"baseQWCamera", "^", "2"}]}], ",", "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"-", "baseQZCamera"}], " ", "/", " ", 
     RowBox[{"baseQWCamera", "^", "2"}]}], ",", "\[IndentingNewLine]", 
    RowBox[{"baseQWCamera", " ", "/", " ", 
     RowBox[{"baseQWCamera", "^", "2"}]}]}], "}"}], 
  "]"}], "\[IndentingNewLine]", 
 RowBox[{"Grid", "[", "tipPositionsCamera", "]"}], "\[IndentingNewLine]", 
 RowBox[{"Clear", "[", 
  RowBox[{
  "baseQXCamera", ",", "\[IndentingNewLine]", "baseQYCamera", ",", 
   "\[IndentingNewLine]", "baseQZCamera", ",", "\[IndentingNewLine]", 
   "baseQWCamera", ",", "\[IndentingNewLine]", "baseXCamera", ",", 
   "\[IndentingNewLine]", "baseYCamera", ",", "\[IndentingNewLine]", 
   "baseZCamera"}], "]"}]}], "Input",
 CellChangeTimes->{{3.5728921888419037`*^9, 3.5728922398058186`*^9}, {
  3.57289228370633*^9, 3.572892319410372*^9}, {3.5728927999348564`*^9, 
  3.5728928271034107`*^9}, {3.5728930419526987`*^9, 3.5728930661230817`*^9}, {
  3.57289791777458*^9, 3.572898030791044*^9}, {3.5728985479296227`*^9, 
  3.572898612887338*^9}}],

Cell[BoxData[
 RowBox[{"{", 
  RowBox[{
   RowBox[{"-", "0.6651111831223262`"}], ",", 
   RowBox[{"-", "0.2855279935039524`"}], ",", 
   RowBox[{"-", "0.6497915803195514`"}], ",", 
   RowBox[{"-", "0.232102953787854`"}]}], "}"}]], "Output",
 CellChangeTimes->{
  3.5728922406108646`*^9, {3.572892309738819*^9, 3.572892320162415*^9}, 
   3.57289240993955*^9, {3.572893042769746*^9, 3.5728930667021146`*^9}, 
   3.572897965192292*^9, {3.57289801987142*^9, 3.5728980318961077`*^9}, {
   3.5728985857907887`*^9, 3.572898614439427*^9}, 3.5733889859275627`*^9, 
   3.573389134460058*^9}],

Cell[BoxData[
 TagBox[GridBox[{
    {"0.20803475942141703`", "0.20595271182345454`", "1.0258826765187605`"},
    {"0.21873282445494602`", "0.2657034164719959`", "0.9908300564483754`"},
    {"0.10840216267906337`", "0.1645546487356781`", "1.0904985462604195`"},
    {
     RowBox[{"-", "0.054346873175769854`"}], "0.06984540393496996`", 
     "1.1558729687626748`"},
    {
     RowBox[{"-", "0.1385173150530084`"}], "0.17406433628432932`", 
     "1.0746771689511567`"},
    {"0.006587786214700964`", "0.028456055270988156`", "1.1455815093507484`"},
    {
     RowBox[{"-", "0.13568534443619729`"}], "0.03604716442419387`", 
     "1.1262082050337665`"},
    {
     RowBox[{"-", "0.21386252188670324`"}], "0.11012886488007712`", 
     "1.0576216225643496`"},
    {"0.09660251978496963`", 
     RowBox[{"-", "0.04910764015037272`"}], "1.2040831030670818`"},
    {
     RowBox[{"-", "0.16624718151117335`"}], "0.1929603088021365`", 
     "0.97974472062292`"},
    {
     RowBox[{"-", "0.05689899369485817`"}], "0.0864486547572631`", 
     "1.078533539308657`"},
    {"0.15854554974450008`", "0.012251531182983388`", "1.1466317852421126`"}
   },
   AutoDelete->False,
   GridBoxItemSize->{"Columns" -> {{Automatic}}, "Rows" -> {{Automatic}}}],
  "Grid"]], "Output",
 CellChangeTimes->{
  3.5728922406108646`*^9, {3.572892309738819*^9, 3.572892320162415*^9}, 
   3.57289240993955*^9, {3.572893042769746*^9, 3.5728930667021146`*^9}, 
   3.572897965192292*^9, {3.57289801987142*^9, 3.5728980318961077`*^9}, {
   3.5728985857907887`*^9, 3.572898614439427*^9}, 3.5733889859275627`*^9, 
   3.573389134467058*^9}]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[{
 RowBox[{
  RowBox[{"tipTFBase", " ", ".", "baseTFCamera"}], " ", 
  ";"}], "\[IndentingNewLine]", "tipTFBase"}], "Input",
 CellChangeTimes->{{3.5728944426478143`*^9, 3.5728944596867886`*^9}}],

Cell[BoxData[
 RowBox[{
  StyleBox[
   RowBox[{"Part", "::", "partd"}], "MessageName"], 
  RowBox[{
  ":", " "}], "\<\"Part specification \[NoBreak]\\!\\(tipPoseBase \
\[LeftDoubleBracket] 5 \[RightDoubleBracket]\\)\[NoBreak] is longer than \
depth of object. \\!\\(\\*ButtonBox[\\\"\[RightSkeleton]\\\", ButtonStyle->\\\
\"Link\\\", ButtonFrame->None, \
ButtonData:>\\\"paclet:ref/message/General/partd\\\", ButtonNote -> \
\\\"Part::partd\\\"]\\)\"\>"}]], "Message", "MSG",
 CellChangeTimes->{3.5733891345060606`*^9}],

Cell[BoxData[
 RowBox[{
  StyleBox[
   RowBox[{"Part", "::", "take"}], "MessageName"], 
  RowBox[{
  ":", " "}], "\<\"Cannot take positions \[NoBreak]\\!\\(4\\)\[NoBreak] \
through \[NoBreak]\\!\\(7\\)\[NoBreak] in \[NoBreak]\\!\\(tipPoseBase\\)\
\[NoBreak]. \\!\\(\\*ButtonBox[\\\"\[RightSkeleton]\\\", \
ButtonStyle->\\\"Link\\\", ButtonFrame->None, \
ButtonData:>\\\"paclet:ref/message/Part/take\\\", ButtonNote -> \
\\\"Part::take\\\"]\\)\"\>"}]], "Message", "MSG",
 CellChangeTimes->{3.573389134583065*^9}],

Cell[BoxData[
 RowBox[{
  StyleBox[
   RowBox[{"Part", "::", "partd"}], "MessageName"], 
  RowBox[{
  ":", " "}], "\<\"Part specification \[NoBreak]\\!\\(tipPoseBase \
\[LeftDoubleBracket] 6 \[RightDoubleBracket]\\)\[NoBreak] is longer than \
depth of object. \\!\\(\\*ButtonBox[\\\"\[RightSkeleton]\\\", ButtonStyle->\\\
\"Link\\\", ButtonFrame->None, \
ButtonData:>\\\"paclet:ref/message/General/partd\\\", ButtonNote -> \
\\\"Part::partd\\\"]\\)\"\>"}]], "Message", "MSG",
 CellChangeTimes->{3.573389134585065*^9}],

Cell[BoxData[
 RowBox[{
  StyleBox[
   RowBox[{"Part", "::", "take"}], "MessageName"], 
  RowBox[{
  ":", " "}], "\<\"Cannot take positions \[NoBreak]\\!\\(4\\)\[NoBreak] \
through \[NoBreak]\\!\\(7\\)\[NoBreak] in \[NoBreak]\\!\\(tipPoseBase\\)\
\[NoBreak]. \\!\\(\\*ButtonBox[\\\"\[RightSkeleton]\\\", \
ButtonStyle->\\\"Link\\\", ButtonFrame->None, \
ButtonData:>\\\"paclet:ref/message/Part/take\\\", ButtonNote -> \
\\\"Part::take\\\"]\\)\"\>"}]], "Message", "MSG",
 CellChangeTimes->{3.573389134587065*^9}],

Cell[BoxData[
 RowBox[{
  StyleBox[
   RowBox[{"Part", "::", "partd"}], "MessageName"], 
  RowBox[{
  ":", " "}], "\<\"Part specification \[NoBreak]\\!\\(tipPoseBase \
\[LeftDoubleBracket] 4 \[RightDoubleBracket]\\)\[NoBreak] is longer than \
depth of object. \\!\\(\\*ButtonBox[\\\"\[RightSkeleton]\\\", ButtonStyle->\\\
\"Link\\\", ButtonFrame->None, \
ButtonData:>\\\"paclet:ref/message/General/partd\\\", ButtonNote -> \
\\\"Part::partd\\\"]\\)\"\>"}]], "Message", "MSG",
 CellChangeTimes->{3.573389134588065*^9}],

Cell[BoxData[
 RowBox[{
  StyleBox[
   RowBox[{"General", "::", "stop"}], "MessageName"], 
  RowBox[{
  ":", " "}], "\<\"Further output of \[NoBreak]\\!\\(\\*StyleBox[\\(Part :: \
partd\\), \\\"MessageName\\\"]\\)\[NoBreak] will be suppressed during this \
calculation. \\!\\(\\*ButtonBox[\\\"\[RightSkeleton]\\\", \
ButtonStyle->\\\"Link\\\", ButtonFrame->None, \
ButtonData:>\\\"paclet:ref/message/General/stop\\\", ButtonNote -> \
\\\"General::stop\\\"]\\)\"\>"}]], "Message", "MSG",
 CellChangeTimes->{3.573389134590066*^9}],

Cell[BoxData[
 RowBox[{
  StyleBox[
   RowBox[{"Part", "::", "take"}], "MessageName"], 
  RowBox[{
  ":", " "}], "\<\"Cannot take positions \[NoBreak]\\!\\(4\\)\[NoBreak] \
through \[NoBreak]\\!\\(7\\)\[NoBreak] in \[NoBreak]\\!\\(tipPoseBase\\)\
\[NoBreak]. \\!\\(\\*ButtonBox[\\\"\[RightSkeleton]\\\", \
ButtonStyle->\\\"Link\\\", ButtonFrame->None, \
ButtonData:>\\\"paclet:ref/message/Part/take\\\", ButtonNote -> \
\\\"Part::take\\\"]\\)\"\>"}]], "Message", "MSG",
 CellChangeTimes->{3.5733891345910654`*^9}],

Cell[BoxData[
 RowBox[{
  StyleBox[
   RowBox[{"General", "::", "stop"}], "MessageName"], 
  RowBox[{
  ":", " "}], "\<\"Further output of \[NoBreak]\\!\\(\\*StyleBox[\\(Part :: \
take\\), \\\"MessageName\\\"]\\)\[NoBreak] will be suppressed during this \
calculation. \\!\\(\\*ButtonBox[\\\"\[RightSkeleton]\\\", \
ButtonStyle->\\\"Link\\\", ButtonFrame->None, \
ButtonData:>\\\"paclet:ref/message/General/stop\\\", ButtonNote -> \
\\\"General::stop\\\"]\\)\"\>"}]], "Message", "MSG",
 CellChangeTimes->{3.5733891345930653`*^9}],

Cell[BoxData[
 RowBox[{"{", 
  RowBox[{
   RowBox[{"{", 
    RowBox[{
     RowBox[{"1", "-", 
      FractionBox[
       RowBox[{"2", " ", 
        SuperscriptBox[
         RowBox[{
         "tipPoseBase", "\[LeftDoubleBracket]", "5", 
          "\[RightDoubleBracket]"}], "2"]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "-", 
      FractionBox[
       RowBox[{"2", " ", 
        SuperscriptBox[
         RowBox[{
         "tipPoseBase", "\[LeftDoubleBracket]", "6", 
          "\[RightDoubleBracket]"}], "2"]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "4", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "5", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "+", 
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "6", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "7", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "4", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "6", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "-", 
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "5", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "7", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{
     "tipPoseBase", "\[LeftDoubleBracket]", "1", "\[RightDoubleBracket]"}]}], 
    "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "4", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "5", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "-", 
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "6", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "7", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{"1", "-", 
      FractionBox[
       RowBox[{"2", " ", 
        SuperscriptBox[
         RowBox[{
         "tipPoseBase", "\[LeftDoubleBracket]", "4", "\[RightDoubleBracket]"}]
          , "2"]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "-", 
      FractionBox[
       RowBox[{"2", " ", 
        SuperscriptBox[
         RowBox[{
         "tipPoseBase", "\[LeftDoubleBracket]", "6", 
          "\[RightDoubleBracket]"}], "2"]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "5", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "6", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "+", 
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "4", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "7", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{
     "tipPoseBase", "\[LeftDoubleBracket]", "2", "\[RightDoubleBracket]"}]}], 
    "}"}], ",", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "4", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "6", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "+", 
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "5", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "7", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "5", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "6", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "-", 
      FractionBox[
       RowBox[{"2", " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "4", "\[RightDoubleBracket]"}],
         " ", 
        RowBox[{
        "tipPoseBase", "\[LeftDoubleBracket]", "7", 
         "\[RightDoubleBracket]"}]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{"1", "-", 
      FractionBox[
       RowBox[{"2", " ", 
        SuperscriptBox[
         RowBox[{
         "tipPoseBase", "\[LeftDoubleBracket]", "4", 
          "\[RightDoubleBracket]"}], "2"]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]], 
      "-", 
      FractionBox[
       RowBox[{"2", " ", 
        SuperscriptBox[
         RowBox[{
         "tipPoseBase", "\[LeftDoubleBracket]", "5", 
          "\[RightDoubleBracket]"}], "2"]}], 
       SuperscriptBox[
        RowBox[{"Norm", "[", 
         RowBox[{"tipPoseBase", "\[LeftDoubleBracket]", 
          RowBox[{"4", ";;", "7"}], "\[RightDoubleBracket]"}], "]"}], "2"]]}],
      ",", 
     RowBox[{
     "tipPoseBase", "\[LeftDoubleBracket]", "3", "\[RightDoubleBracket]"}]}], 
    "}"}], ",", 
   RowBox[{"{", 
    RowBox[{"0", ",", "0", ",", "0", ",", "1"}], "}"}]}], "}"}]], "Output",
 CellChangeTimes->{
  3.57289292430797*^9, {3.5728944466500435`*^9, 3.5728944605018353`*^9}, 
   3.5733891345960655`*^9}]
}, Open  ]],

Cell[CellGroupData[{

Cell[BoxData[
 RowBox[{"Norm", "[", 
  RowBox[{"{", 
   RowBox[{
   "tipQXBase", ",", "tipQYBase", ",", "tipQZBase", ",", "tipQWBase"}], "}"}],
   "]"}]], "Input"],

Cell[BoxData[
 SqrtBox[
  RowBox[{
   SuperscriptBox[
    RowBox[{"Abs", "[", "tipQWBase", "]"}], "2"], "+", 
   SuperscriptBox[
    RowBox[{"Abs", "[", "tipQXBase", "]"}], "2"], "+", 
   SuperscriptBox[
    RowBox[{"Abs", "[", "tipQYBase", "]"}], "2"], "+", 
   SuperscriptBox[
    RowBox[{"Abs", "[", "tipQZBase", "]"}], "2"]}]]], "Output",
 CellChangeTimes->{3.572893036184369*^9, 3.573389134635068*^9}]
}, Open  ]]
},
WindowSize->{1664, 915},
WindowMargins->{{0, Automatic}, {Automatic, 0}},
FrontEndVersion->"8.0 for Microsoft Windows (64-bit) (February 23, 2011)",
StyleDefinitions->"Default.nb"
]
(* End of Notebook Content *)

(* Internal cache information *)
(*CellTagsOutline
CellTagsIndex->{}
*)
(*CellTagsIndex
CellTagsIndex->{}
*)
(*NotebookFileOutline
Notebook[{
Cell[CellGroupData[{
Cell[579, 22, 35002, 797, 2372, "Input"],
Cell[35584, 821, 1815, 43, 50, "Output"],
Cell[37402, 866, 3521, 69, 88, "Output"],
Cell[40926, 937, 609, 8, 30, "Output"]
}, Open  ]],
Cell[CellGroupData[{
Cell[41572, 950, 2086, 49, 392, "Input"],
Cell[43661, 1001, 581, 12, 30, "Output"],
Cell[44245, 1015, 1600, 36, 192, "Output"]
}, Open  ]],
Cell[CellGroupData[{
Cell[45882, 1056, 207, 4, 52, "Input"],
Cell[46092, 1062, 519, 11, 21, "Message"],
Cell[46614, 1075, 511, 11, 21, "Message"],
Cell[47128, 1088, 517, 11, 21, "Message"],
Cell[47648, 1101, 511, 11, 21, "Message"],
Cell[48162, 1114, 517, 11, 21, "Message"],
Cell[48682, 1127, 528, 11, 21, "Message"],
Cell[49213, 1140, 513, 11, 21, "Message"],
Cell[49729, 1153, 529, 11, 21, "Message"],
Cell[50261, 1166, 8741, 253, 138, "Output"]
}, Open  ]],
Cell[CellGroupData[{
Cell[59039, 1424, 163, 5, 31, "Input"],
Cell[59205, 1431, 406, 11, 38, "Output"]
}, Open  ]]
}
]
*)

(* End of internal cache information *)