template <typename T> inline Math::Vector3<T> operator* (SymMatrix3<T> m, Math::Vector3<T> v) { return Math::Vector3<T> ( m.aa()*v.x() + m.ab()*v.y() + m.ac()*v.z(), m.ab()*v.x() + m.bb()*v.y() + m.bc()*v.z(), m.ac()*v.x() + m.bc()*v.y() + m.cc()*v.z() ); }
DipoleGeometry::DipoleGeometry (ldouble gridUnit, Math::Vector3<ldouble> periodicity1, Math::Vector3<ldouble> periodicity2) : box_ (0, 0, 0), matCount_ (0), validNvCount_ (0), origin_ (0, 0, 0), orientation_ (EMSim::Rotation<ldouble>::none ()), orientationInverse_ (EMSim::Rotation<ldouble>::none ()), gridUnit_ (gridUnit), periodicity1_ (periodicity1), periodicity2_ (periodicity2) { ASSERT (gridUnit >= 0); bool periodicity1IsZero = periodicity1.x () == 0 && periodicity1.y () == 0 && periodicity1.z () == 0; bool periodicity2IsZero = periodicity2.x () == 0 && periodicity2.y () == 0 && periodicity2.z () == 0; if (periodicity1IsZero) { ASSERT (periodicity2IsZero); periodicityDimension_ = 0; } else { if (periodicity2IsZero) { periodicityDimension_ = 1; } else { periodicityDimension_ = 2; } } gridUnitVol_ = gridUnit * gridUnit * gridUnit; }
void parse (StringParser& p, Math::Vector3<T>& out) { size_t start = p.pos (); p.expect (typeid (Math::Vector3<T>), start, '('); parse (p, out.x ()); p.expect (typeid (Math::Vector3<T>), start, ','); parse (p, out.y ()); p.expect (typeid (Math::Vector3<T>), start, ','); parse (p, out.z ()); p.expect (typeid (Math::Vector3<T>), start, ')'); }
void TLens::set_thickness(double thickness, unsigned int index) { double diff = thickness - get_thickness(index); for (unsigned int i = index; i < _surfaces.size(); i++) { Math::Vector3 p = _surfaces[i].get_local_position(); p.z() += diff; _surfaces[i].set_local_position(p); } _last_pos += diff; }
void Box::createDipoleGeometry (DipoleGeometry& dipoleGeometry) const { Math::Vector3<ldouble> size = this->size () / dipoleGeometry.gridUnit (); size_t mat = dipoleGeometry.materials ().size (); dipoleGeometry.materials ().push_back (material ()); for (uint32_t z = 0; z < size.z (); z++) { for (uint32_t y = 0; y < size.y (); y++) { for (uint32_t x = 0; x < size.x (); x++) { ASSERT (mat <= 255); dipoleGeometry.addDipole (x, y, z, static_cast<uint8_t> (mat)); } } } dipoleGeometry.moveToCenter (); }
void DipoleGeometry::normalize () { if (nvCount () == 0) return; Math::Vector3<uint32_t> min = Math::Vector3<uint32_t> (std::numeric_limits<uint32_t>::max (), std::numeric_limits<uint32_t>::max (), std::numeric_limits<uint32_t>::max ()); for (uint32_t i = 0; i < nvCount (); i++) { Math::Vector3<uint32_t> coords = getGridCoordinates (i); if (coords.x () < min.x ()) min.x () = coords.x (); if (coords.y () < min.y ()) min.y () = coords.y (); if (coords.z () < min.z ()) min.z () = coords.z (); } if (min != Math::Vector3<uint32_t> (0, 0, 0)) { for (uint32_t i = 0; i < nvCount (); i++) { positions_[i] -= min; } box_ -= min; origin () += min * gridUnit (); } }
void set (std::vector<U>& vector, size_t index, const Math::Vector3<U>& value) const { vector[index] = value.x (); vector[index + vecStride ()] = value.y (); vector[index + 2 * vecStride ()] = value.z (); }