关于求点坐标的问题

题目：已知点p(1),p(2)....p(4),L=1,要求：p(i)p(i+1)//q(i)q(i+1),p(i)p(i+1)与q(i)q(i+1)距离相等，距离都为L，求q(1),q(2)...q(4)坐标.
p(1)坐标为（3,1）
p(2)坐标为（0,4）
p(3)坐标为（1,5）
p(4)坐标为（0,6）
希望大家帮忙看看，能写出完整程序的帮忙写下，谢谢大家

本人做的以下程序：
#include<iostream>
#include <math.h>
using namespace std;
int main()
{




int i,a[4],b[4],k,l=1,p,x[4],y[4],A;

a[0]=3;b[0]=1;
a[1]=0;b[1]=4;
a[2]=1;b[2]=5;
a[3]=0;b[3]=6;
for(i=1;i<4;i++)
    {
    k=(b[i]-b[i-1])/(a[i]-a[i-1]);
//    cout<<k<<endl;
    A=l/k;
    p=sqrt(l^2+A^2);
    x[0]=a[0]+p;
//    cout<<"x[0]="<<x[0]<<endl;
    x[i]=x[i-1]+p;
    cout<<x[i]<<endl;
   
   
    }

return 0;

}