Finished cleaning up angle sensor work