Найти центр и радиус вписанной

//Вычисление радиуса и координат центра окружности,вписанной в треугольник,заданный координатами вершин.
//(x0,y0) - точка пересечения биссектрис треугольника, т.е. центр вписанной окружности.
#include <cstdlib>
#include <cmath>
#include <iostream>
 
using namespace std;
 
int main(int argc, char *argv[])
{
    double x1,y1,x2,y2,x3,y3,p,r,S,x0,y0,a,b,c;
    cout<<"Koordinaty a: "; cin>>x1>>y1;
    cout<<"Koordinaty b: "; cin>>x2>>y2;
    cout<<"Koordinaty c: "; cin>>x3>>y3;
    a = sqrt((x2 - x1)*(x2 - x1) + (y2 - y1)*(y2 - y1));
    b = sqrt((x3 - x2)*(x3 - x2) + (y3 - y2)*(y3 - y2));
    c = sqrt((x3 - x1)*(x3 - x1) + (y3 - y1)*(y3 - y1));
    p = (a+b+c)/2;
    S = 0.5 * abs(((x2 - x1)*(y3 - y1) - (x3 - x1)*(y2 - y1)));
    r = S/p;
    x0 = ((x1 + x2 - 2*x3)*((y3 - y1)*(x2 + x3 - 2*x1) + x1*(y2 + y3 - 2*y1)) - x3*(x2 + x3 - 2*x1)*(y1 + y2 - 2*y3))/((y2 + y3 - 2*y1)*(x1 + x2 - 2*x3) - (x2 + x3 - 2*x1)*(y1 + y2 - 2*y3));
    y0 = ((x0 - x1)*(y2 + y3 - 2*y1)/(x2 + x3 - 2*x1)) + y1;
    cout<<"Radius: "<<r<<endl;
    cout<<"Koordinaty centra: "<<"("<<x0<<" , "<<y0<<")"<<endl;
    system("PAUSE");
    return EXIT_SUCCESS;
}