Took out stupid matrix casts, much faster now.