曲率计算问题

上式中要求出三边长，会用到求根公式，在单片机中开根号，那是很要命的。
如果精度要求不高，可以自已写一个简单的求根函数，东北大学给出的函数是
unsigned int m_sqrt(unsigned int x)
{
            uchar ans=0,p=0x80;
           while(p!=0)
                     {
                          ans+=p;
                         if(ans*ans>x)
                    {
            ans-=p;
}
            p=(uchar)(p/2);
}
            return(ans);
}