void StandardLocationService::locationUpdate(UUID source, void* buffer, uint32 length) { Sirikata::Protocol::Loc::Container loc_container; bool parse_success = loc_container.ParseFromString( String((char*) buffer, length) ); if (!parse_success) { LOG_INVALID_MESSAGE_BUFFER(standardloc, error, ((char*)buffer), length); return; } if (loc_container.has_update_request()) { Sirikata::Protocol::Loc::LocationUpdateRequest request = loc_container.update_request(); TrackingType obj_type = type(source); if (obj_type == Local) { LocationMap::iterator loc_it = mLocations.find( source ); assert(loc_it != mLocations.end()); if (request.has_location()) { TimedMotionVector3f newloc( request.location().t(), MotionVector3f( request.location().position(), request.location().velocity() ) ); loc_it->second.location = newloc; notifyLocalLocationUpdated( source, loc_it->second.aggregate, newloc ); CONTEXT_SPACETRACE(serverLoc, mContext->id(), mContext->id(), source, newloc ); } if (request.has_bounds()) { BoundingSphere3f newbounds = request.bounds(); loc_it->second.bounds = newbounds; notifyLocalBoundsUpdated( source, loc_it->second.aggregate, newbounds ); } if (request.has_mesh()) { String newmesh = request.mesh(); loc_it->second.mesh = newmesh; notifyLocalMeshUpdated( source, loc_it->second.aggregate, newmesh ); } if (request.has_orientation()) { TimedMotionQuaternion neworient( request.orientation().t(), MotionQuaternion( request.orientation().position(), request.orientation().velocity() ) ); loc_it->second.orientation = neworient; notifyLocalOrientationUpdated( source, loc_it->second.aggregate, neworient ); } if (request.has_physics()) { String newphy = request.physics(); loc_it->second.physics = newphy; notifyLocalPhysicsUpdated( source, loc_it->second.aggregate, newphy ); } } else { // Warn about update to non-local object } } }
void BulletRigidBodyObject::updateObjectFromBullet(const btTransform& worldTrans) { assert(mFixed == false); LocationInfo& locinfo = mParent->info(mID); btVector3 pos = worldTrans.getOrigin(); btVector3 vel = mObjRigidBody->getLinearVelocity(); TimedMotionVector3f newLocation(mParent->context()->simTime(), MotionVector3f(Vector3f(pos.x(), pos.y(), pos.z()), Vector3f(vel.x(), vel.y(), vel.z()))); mParent->setLocation(mID, newLocation); BULLETLOG(insane, "Updating " << mID << " to velocity " << vel.x() << " " << vel.y() << " " << vel.z()); btQuaternion rot = worldTrans.getRotation(); btVector3 angvel = mObjRigidBody->getAngularVelocity(); Vector3f angvel_siri(angvel.x(), angvel.y(), angvel.z()); float angvel_angle = angvel_siri.normalizeThis(); TimedMotionQuaternion newOrientation( mParent->context()->simTime(), MotionQuaternion( Quaternion(rot.x(), rot.y(), rot.z(), rot.w()), Quaternion(angvel_siri, angvel_angle) ) ); mParent->setOrientation(mID, newOrientation); mParent->addUpdate(mID); }
void BulletCharacterObject::postTick(const Time& t) { LocationInfo& locinfo = mParent->info(mID); btTransform worldTrans = mGhostObject->getWorldTransform(); btVector3 pos = worldTrans.getOrigin(); TimedMotionVector3f newLocation(t, MotionVector3f(Vector3f(pos.x(), pos.y(), pos.z()), locinfo.props.location().velocity())); btQuaternion rot = worldTrans.getRotation(); TimedMotionQuaternion newOrientation( t, MotionQuaternion( Quaternion(rot.x(), rot.y(), rot.z(), rot.w()), locinfo.props.orientation().velocity() ) ); // Only update and report a change if it's big enough. This allows us to // stop sending updates if the object ends up essentially still. float32 pos_diff = (mParent->location(mID).position(t)-newLocation.position(t)).lengthSquared(); // This test is easy, but also conservative... float32 angle1, angle2; Vector3f axis1, axis2; mParent->orientation(mID).position(t).toAngleAxis(angle1, axis1); newOrientation.position(t).toAngleAxis(angle2, axis2); // FIXME what should this really be? This approach doesn't seem to really // work because we sometimes get 0 vectors and the constants seem odd... bool orient_changed = (axis1.dot(axis2) < 0.9) || (fabs(angle1-angle2) > 3.14159/180); if (pos_diff > 0.001 || orient_changed) { mParent->setLocation(mID, newLocation); mParent->setOrientation(mID, newOrientation); mParent->addUpdate(mID); } }
TimedMotionQuaternion LocProtocolLocUpdate::orientation() const { Sirikata::Protocol::TimedMotionQuaternion update_orient = mUpdate.orientation(); return TimedMotionQuaternion( mSync.localTime(update_orient.t()), MotionQuaternion(update_orient.position(), update_orient.velocity()) ); }
PresenceProperties() : mLoc(Time::null(), MotionVector3f(Vector3f::zero(), Vector3f::zero())), mOrientation(Time::null(), MotionQuaternion(Quaternion::identity(), Quaternion::identity())), mBounds(Vector3f::zero(), 0), mMesh(), mPhysics(), mIsAggregate(false), mParent(ObjectReference::null()) {}
void ProxyObject::setOrientation(const TimedMotionQuaternion& reqorient, uint64 seqno, bool predictive) { if (seqno < mUpdateSeqno[LOC_ORIENT_PART] && !predictive) return; if (!predictive) mUpdateSeqno[LOC_ORIENT_PART] = seqno; mOrientation = TimedMotionQuaternion(reqorient.time(), MotionQuaternion(reqorient.position(), reqorient.velocity())); PositionProvider::notify(&PositionListener::updateLocation, mLoc, mOrientation, mBounds); }
void SimpleCameraObjectScript::rotateAction(Vector3f about, float amount) { // Get the updated position Time now = context()->simTime(); Location loc = mSelfProxy->extrapolateLocation(now); const Quaternion &orient = loc.getOrientation(); TimedMotionQuaternion neworient(now, MotionQuaternion(loc.getOrientation(), Quaternion(about, amount))); mParent->requestOrientationUpdate(mID.space(), mID.object(), neworient); }
void SimpleCameraObjectScript::rotateAction(Vector3f about, float amount) { // Get the updated position Time now = context()->simTime(); Location loc = mSelfProxy->extrapolateLocation(now); const Quaternion &orient = loc.getOrientation(); TimedMotionQuaternion neworient(now, MotionQuaternion(loc.getOrientation(), Quaternion(about, amount))); mParent->requestOrientationUpdate(mID.space(), mID.object(), neworient); // And update our local Proxy's information, assuming the move will be successful mSelfProxy->setOrientation(neworient, 0, true); }
ProxyObject::ProxyObject(ProxyManager *man, const SpaceObjectReference&id, VWObjectPtr vwobj, const SpaceObjectReference& owner_sor) : SelfWeakPtr<ProxyObject>(), ProxyObjectProvider(), MeshProvider (), mID(id), mManager(man), mLoc(Time::null(), MotionVector3f(Vector3f::nil(), Vector3f::nil())), mOrientation(Time::null(), MotionQuaternion(Quaternion::identity(), Quaternion::identity())), mParent(vwobj), mMeshURI() { assert(mParent); mDefaultPort = mParent->bindODPPort(owner_sor); reset(); validate(); }
void SimpleCameraObjectScript::stableRotateAction(float dir, float amount) { // Get the updated position Time now = context()->simTime(); Location loc = mSelfProxy->extrapolateLocation(now); const Quaternion &orient = loc.getOrientation(); double p, r, y; quat2Euler(orient, p, r, y); Vector3f raxis; raxis.x = 0; raxis.y = std::cos(p*DEG2RAD); raxis.z = -std::sin(p*DEG2RAD); // Request updates from spcae TimedMotionQuaternion neworient(now, MotionQuaternion(loc.getOrientation(), Quaternion(raxis, dir*amount))); mParent->requestOrientationUpdate(mID.space(), mID.object(), neworient); }
bool HostedObject::objectHostConnect(const SpaceID spaceID, const Location startingLocation, const BoundingSphere3f meshBounds, const String mesh, const String physics, const String query, const String zernike, const ObjectReference orefID, PresenceToken token) { ObjectReference oref = (orefID == ObjectReference::null()) ? ObjectReference(UUID::random()) : orefID; SpaceObjectReference connectingSporef (spaceID,oref); // Note: we always use Time::null() here. The server will fill in the // appropriate value. When we get the callback, we can fix this up. Time approx_server_time = Time::null(); if (mObjectHost->connect( getSharedPtr(), connectingSporef, spaceID, TimedMotionVector3f(approx_server_time, MotionVector3f( Vector3f(startingLocation.getPosition()), startingLocation.getVelocity()) ), TimedMotionQuaternion(approx_server_time,MotionQuaternion(startingLocation.getOrientation().normal(),Quaternion(startingLocation.getAxisOfRotation(),startingLocation.getAngularSpeed()))), //normalize orientations meshBounds, mesh, physics, query, zernike, std::tr1::bind(&HostedObject::handleConnected, getWeakPtr(), mObjectHost, _1, _2, _3), std::tr1::bind(&HostedObject::handleMigrated, getWeakPtr(), _1, _2, _3), std::tr1::bind(&HostedObject::handleStreamCreated, getWeakPtr(), _1, _2, token), std::tr1::bind(&HostedObject::handleDisconnected, getWeakPtr(), _1, _2) )) { mObjectHost->registerHostedObject(connectingSporef,getSharedPtr()); return true; }else { return false; } }
void StandardLocationService::receiveMessage(Message* msg) { assert(msg->dest_port() == SERVER_PORT_LOCATION); Sirikata::Protocol::Loc::BulkLocationUpdate contents; bool parsed = parsePBJMessage(&contents, msg->payload()); if (parsed) { for(int32 idx = 0; idx < contents.update_size(); idx++) { Sirikata::Protocol::Loc::LocationUpdate update = contents.update(idx); // Its possible we'll get an out of date update. We only use this update // if (a) we have this object marked as a replica object and (b) we don't // have this object marked as a local object if (type(update.object()) != Replica) continue; LocationMap::iterator loc_it = mLocations.find( update.object() ); // We can safely make this assertion right now because space server // to space server loc and prox are on the same reliable channel. If // this goes away then a) we can't make this assertion and b) we // need an OrphanLocUpdateManager to save updates where this // condition is false so they can be applied once the prox update // arrives. assert(loc_it != mLocations.end()); if (update.has_location()) { TimedMotionVector3f newloc( update.location().t(), MotionVector3f( update.location().position(), update.location().velocity() ) ); loc_it->second.location = newloc; notifyReplicaLocationUpdated( update.object(), newloc ); CONTEXT_SPACETRACE(serverLoc, msg->source_server(), mContext->id(), update.object(), newloc ); } if (update.has_orientation()) { TimedMotionQuaternion neworient( update.orientation().t(), MotionQuaternion( update.orientation().position(), update.orientation().velocity() ) ); loc_it->second.orientation = neworient; notifyReplicaOrientationUpdated( update.object(), neworient ); } if (update.has_bounds()) { BoundingSphere3f newbounds = update.bounds(); loc_it->second.bounds = newbounds; notifyReplicaBoundsUpdated( update.object(), newbounds ); } if (update.has_mesh()) { String newmesh = update.mesh(); loc_it->second.mesh = newmesh; notifyReplicaMeshUpdated( update.object(), newmesh ); } if (update.has_physics()) { String newphy = update.physics(); loc_it->second.physics = newphy; notifyReplicaPhysicsUpdated( update.object(), newphy ); } } } delete msg; }