use crate::ArchetypeAccess; use hecs::{ Archetype, Component, ComponentError, Entity, Fetch, Query as HecsQuery, Ref, RefMut, World, }; use std::marker::PhantomData; pub struct Query<'a, Q: HecsQuery> { pub(crate) world: &'a World, pub(crate) archetype_access: &'a ArchetypeAccess, _marker: PhantomData, } #[derive(Debug)] pub enum QueryComponentError { CannotReadArchetype, CannotWriteArchetype, ComponentError(ComponentError), } impl<'a, Q: HecsQuery> Query<'a, Q> { #[inline] pub fn new(world: &'a World, archetype_access: &'a ArchetypeAccess) -> Self { Self { world, archetype_access, _marker: PhantomData::default(), } } #[inline] pub fn iter(&mut self) -> QueryBorrow<'_, Q> { QueryBorrow::new(&self.world.archetypes, self.archetype_access) } /// Gets a reference to the entity's component of the given type. This will fail if the entity does not have /// the given component type or if the given component type does not match this query. pub fn get(&self, entity: Entity) -> Result, QueryComponentError> { if let Some(location) = self.world.get_entity_location(entity) { if self .archetype_access .immutable .contains(location.archetype as usize) || self .archetype_access .mutable .contains(location.archetype as usize) { self.world .get(entity) .map_err(|err| QueryComponentError::ComponentError(err)) } else { Err(QueryComponentError::CannotReadArchetype) } } else { Err(QueryComponentError::ComponentError( ComponentError::NoSuchEntity, )) } } /// Gets a mutable reference to the entity's component of the given type. This will fail if the entity does not have /// the given component type or if the given component type does not match this query. pub fn get_mut( &self, entity: Entity, ) -> Result, QueryComponentError> { if let Some(location) = self.world.get_entity_location(entity) { if self .archetype_access .mutable .contains(location.archetype as usize) { self.world .get_mut(entity) .map_err(|err| QueryComponentError::ComponentError(err)) } else { Err(QueryComponentError::CannotWriteArchetype) } } else { Err(QueryComponentError::ComponentError( ComponentError::NoSuchEntity, )) } } pub fn removed(&self) -> &[Entity] { self.world.removed::() } /// Sets the entity's component to the given value. This will fail if the entity does not already have /// the given component type or if the given component type does not match this query. pub fn set( &self, entity: Entity, component: T, ) -> Result<(), QueryComponentError> { let mut current = self.get_mut::(entity)?; *current = component; Ok(()) } } /// A borrow of a `World` sufficient to execute the query `Q` /// /// Note that borrows are not released until this object is dropped. pub struct QueryBorrow<'w, Q: HecsQuery> { archetypes: &'w [Archetype], archetype_access: &'w ArchetypeAccess, _marker: PhantomData, } impl<'w, Q: HecsQuery> QueryBorrow<'w, Q> { pub(crate) fn new(archetypes: &'w [Archetype], archetype_access: &'w ArchetypeAccess) -> Self { for index in archetype_access.immutable.ones() { Q::Fetch::borrow(&archetypes[index]); } for index in archetype_access.mutable.ones() { Q::Fetch::borrow(&archetypes[index]); } Self { archetypes, archetype_access, _marker: PhantomData, } } /// Execute the query /// /// Must be called only once per query. #[inline] pub fn iter<'q>(&'q mut self) -> QueryIter<'q, 'w, Q> { QueryIter { borrow: self, archetype_index: 0, iter: None, } } } unsafe impl<'w, Q: HecsQuery> Send for QueryBorrow<'w, Q> {} unsafe impl<'w, Q: HecsQuery> Sync for QueryBorrow<'w, Q> {} impl<'w, Q: HecsQuery> Drop for QueryBorrow<'w, Q> { #[inline] fn drop(&mut self) { for index in self.archetype_access.immutable.ones() { Q::Fetch::release(&self.archetypes[index]); } for index in self.archetype_access.mutable.ones() { Q::Fetch::release(&self.archetypes[index]); } } } impl<'q, 'w, Q: HecsQuery> IntoIterator for &'q mut QueryBorrow<'w, Q> { type IntoIter = QueryIter<'q, 'w, Q>; type Item = >::Item; #[inline] fn into_iter(self) -> Self::IntoIter { self.iter() } } /// Iterator over the set of entities with the components in `Q` pub struct QueryIter<'q, 'w, Q: HecsQuery> { borrow: &'q mut QueryBorrow<'w, Q>, archetype_index: u32, iter: Option>, } unsafe impl<'q, 'w, Q: HecsQuery> Send for QueryIter<'q, 'w, Q> {} unsafe impl<'q, 'w, Q: HecsQuery> Sync for QueryIter<'q, 'w, Q> {} impl<'q, 'w, Q: HecsQuery> Iterator for QueryIter<'q, 'w, Q> { type Item = >::Item; #[inline] fn next(&mut self) -> Option { loop { match self.iter { None => { let archetype = self.borrow.archetypes.get(self.archetype_index as usize)?; self.archetype_index += 1; unsafe { self.iter = Q::Fetch::get(archetype, 0).map(|fetch| ChunkIter { fetch, len: archetype.len(), }); } } Some(ref mut iter) => match unsafe { iter.next() } { None => { self.iter = None; continue; } Some(components) => { return Some(components); } }, } } } fn size_hint(&self) -> (usize, Option) { let n = self.len(); (n, Some(n)) } } impl<'q, 'w, Q: HecsQuery> ExactSizeIterator for QueryIter<'q, 'w, Q> { fn len(&self) -> usize { self.borrow .archetypes .iter() .filter(|&x| Q::Fetch::access(x).is_some()) .map(|x| x.len() as usize) .sum() } } struct ChunkIter { fetch: Q::Fetch, len: u32, } impl ChunkIter { #[inline] unsafe fn next<'a, 'w>(&mut self) -> Option<>::Item> { loop { if self.len == 0 { return None; } self.len -= 1; if self.fetch.should_skip() { // we still need to progress the iterator let _ = self.fetch.next(); continue; } break Some(self.fetch.next()); } } }