Added FPS target and status, fixed math bug