Replace jrl-mathtools by eigen for small vector and matrices

  Fix the code where syntax has become incorrect,
  Add eigen macro for memory alignment in classes containing fix size elements,
  add std:: where required.