Added targetpoint visualization