first take at PID control. Not functional yet