Updated power modelling stuff. Still has issues with servocontroller though