#include <gdk/gdkkeysyms.h>

#include "pencil-context.h"

#include "desktop.h"

#include "desktop-handles.h"

#include "selection.h"

#include "selection-chemistry.h"

#include "draw-anchor.h"

#include "message-stack.h"

#include "message-context.h"

#include "modifier-fns.h"

#include "sp-path.h"

#include "preferences.h"

#include "snap.h"

#include "pixmaps/cursor-pencil.xpm"

#include <2geom/sbasis-to-bezier.h>

#include <2geom/bezier-utils.h>

#include "display/canvas-bpath.h"

#include <glibmm/i18n.h>

#include "context-fns.h"

#include "sp-namedview.h"

#include "xml/repr.h"

#include "document.h"

#include "desktop-style.h"

#include "macros.h"

#include "display/sp-canvas.h"

#include "display/curve.h"

#include "livarot/Path.h"

static gint pencil_handle_button_press(SPPencilContext *const pc, GdkEventButton const &bevent);

static gint pencil_handle_motion_notify(SPPencilContext *const pc, GdkEventMotion const &mevent);

static gint pencil_handle_button_release(SPPencilContext *const pc, GdkEventButton const &revent);

static gint pencil_handle_key_press(SPPencilContext *const pc, guint const keyval, guint const state);

static gint pencil_handle_key_release(SPPencilContext *const pc, guint const keyval, guint const state);

static void spdc_set_startpoint(SPPencilContext *pc, Geom::Point const &p);

static void spdc_set_endpoint(SPPencilContext *pc, Geom::Point const &p);

static void spdc_finish_endpoint(SPPencilContext *pc);

static void spdc_add_freehand_point(SPPencilContext *pc, Geom::Point const &p, guint state);

static void fit_and_split(SPPencilContext *pc);

static void interpolate(SPPencilContext *pc);

static void sketch_interpolate(SPPencilContext *pc);

static Geom::Point pencil_drag_origin_w(0, 0);

static bool pencil_within_tolerance = false;

static bool in_svg_plane(Geom::Point const &p) { return Geom::LInfty(p) < 1e18; }

#include "tool-factory.h"

namespace {

SPEventContext* createPencilContext() {

return new SPPencilContext();

}

bool pencilContextRegistered = ToolFactory::instance().registerObject("/tools/freehand/pencil", createPencilContext);

}

const std::string& SPPencilContext::getPrefsPath() {

return SPPencilContext::prefsPath;

}

const std::string SPPencilContext::prefsPath = "/tools/freehand/pencil";

SPPencilContext::SPPencilContext() : SPDrawContext() {

SPPencilContext* pc = this;

pc->is_drawing = false;

SPEventContext *event_context = SP_EVENT_CONTEXT(pc);

event_context->cursor_shape = cursor_pencil_xpm;

event_context->hot_x = 4;

event_context->hot_y = 4;

pc->npoints = 0;

pc->state = SP_PENCIL_CONTEXT_IDLE;

pc->req_tangent = Geom::Point(0, 0);

// since SPPencilContext is not properly constructed...

pc->sketch_interpolation = Geom::Piecewise<Geom::D2<Geom::SBasis> >();

pc->sketch_n = 0;

}

void SPPencilContext::setup() {

SPEventContext* ec = this;

Inkscape::Preferences *prefs = Inkscape::Preferences::get();

if (prefs->getBool("/tools/freehand/pencil/selcue")) {

ec->enableSelectionCue();

}

SPDrawContext::setup();

SPPencilContext *const pc = SP_PENCIL_CONTEXT(ec);

pc->is_drawing = false;

pc->anchor_statusbar = false;

}

SPPencilContext::~SPPencilContext() {

}

static void

spdc_endpoint_snap(SPPencilContext const *pc, Geom::Point &p, guint const state)

{

if ((state & GDK_CONTROL_MASK)) { //CTRL enables constrained snapping

if (pc->npoints > 0) {

spdc_endpoint_snap_rotation(pc, p, pc->p[0], state);

}

} else {

if (!(state & GDK_SHIFT_MASK)) { //SHIFT disables all snapping, except the angular snapping above

//After all, the user explicitely asked for angular snapping by

//pressing CTRL

boost::optional<Geom::Point> origin = pc->npoints > 0 ? pc->p[0] : boost::optional<Geom::Point>();

spdc_endpoint_snap_free(pc, p, origin, state);

}

}

}

bool SPPencilContext::root_handler(GdkEvent* event) {

SPEventContext* ec = this;

SPPencilContext *const pc = SP_PENCIL_CONTEXT(ec);

gint ret = FALSE;

switch (event->type) {

case GDK_BUTTON_PRESS:

ret = pencil_handle_button_press(pc, event->button);

break;

case GDK_MOTION_NOTIFY:

ret = pencil_handle_motion_notify(pc, event->motion);

break;

case GDK_BUTTON_RELEASE:

ret = pencil_handle_button_release(pc, event->button);

break;

case GDK_KEY_PRESS:

ret = pencil_handle_key_press(pc, get_group0_keyval (&event->key), event->key.state);

break;

case GDK_KEY_RELEASE:

ret = pencil_handle_key_release(pc, get_group0_keyval (&event->key), event->key.state);

break;

default:

break;

}

if (!ret) {

ret = SPDrawContext::root_handler(event);

}

return ret;

}

static gint

pencil_handle_button_press(SPPencilContext *const pc, GdkEventButton const &bevent)

{

gint ret = FALSE;

SPEventContext *event_context = SP_EVENT_CONTEXT(pc);

if ( bevent.button == 1 && !event_context->space_panning) {

SPDrawContext *dc = SP_DRAW_CONTEXT (pc);

SPDesktop *desktop = SP_EVENT_CONTEXT_DESKTOP(dc);

Inkscape::Selection *selection = sp_desktop_selection(desktop);

if (Inkscape::have_viable_layer(desktop, dc->_message_context) == false) {

return TRUE;

}

if (!pc->grab) {

/* Grab mouse, so release will not pass unnoticed */

pc->grab = SP_CANVAS_ITEM(desktop->acetate);

sp_canvas_item_grab(pc->grab, ( GDK_KEY_PRESS_MASK | GDK_BUTTON_PRESS_MASK |

GDK_BUTTON_RELEASE_MASK |

GDK_POINTER_MOTION_MASK ),

NULL, bevent.time);

}

Geom::Point const button_w(bevent.x, bevent.y);

/* Find desktop coordinates */

Geom::Point p = pc->desktop->w2d(button_w);

/* Test whether we hit any anchor. */

SPDrawAnchor *anchor = spdc_test_inside(pc, button_w);

pencil_drag_origin_w = Geom::Point(bevent.x,bevent.y);

pencil_within_tolerance = true;

switch (pc->state) {

case SP_PENCIL_CONTEXT_ADDLINE:

/* Current segment will be finished with release */

ret = TRUE;

break;

default:

/* Set first point of sequence */

SnapManager &m = desktop->namedview->snap_manager;

if (bevent.state & GDK_CONTROL_MASK) {

m.setup(desktop);

if (!(bevent.state & GDK_SHIFT_MASK)) {

m.freeSnapReturnByRef(p, Inkscape::SNAPSOURCE_NODE_HANDLE);

}

spdc_create_single_dot(event_context, p, "/tools/freehand/pencil", bevent.state);

m.unSetup();

ret = true;

break;

}

if (anchor) {

p = anchor->dp;

desktop->messageStack()->flash(Inkscape::NORMAL_MESSAGE, _("Continuing selected path"));

} else {

m.setup(desktop);

if (!(bevent.state & GDK_SHIFT_MASK)) {

// This is the first click of a new curve; deselect item so that

// this curve is not combined with it (unless it is drawn from its

// anchor, which is handled by the sibling branch above)

selection->clear();

desktop->messageStack()->flash(Inkscape::NORMAL_MESSAGE, _("Creating new path"));

m.freeSnapReturnByRef(p, Inkscape::SNAPSOURCE_NODE_HANDLE);

} else if (selection->singleItem() && SP_IS_PATH(selection->singleItem())) {

desktop->messageStack()->flash(Inkscape::NORMAL_MESSAGE, _("Appending to selected path"));

m.freeSnapReturnByRef(p, Inkscape::SNAPSOURCE_NODE_HANDLE);

}

m.unSetup();

}

pc->sa = anchor;

spdc_set_startpoint(pc, p);

ret = TRUE;

break;

}

pc->is_drawing = true;

}

return ret;

}

static gint

pencil_handle_motion_notify(SPPencilContext *const pc, GdkEventMotion const &mevent)

{

SPDesktop *const dt = pc->desktop;

if ((mevent.state & GDK_CONTROL_MASK) && (mevent.state & GDK_BUTTON1_MASK)) {

// mouse was accidentally moved during Ctrl+click;

// ignore the motion and create a single point

pc->is_drawing = false;

return TRUE;

}

gint ret = FALSE;

SPEventContext *event_context = SP_EVENT_CONTEXT(pc);

if (event_context->space_panning || mevent.state & GDK_BUTTON2_MASK || mevent.state & GDK_BUTTON3_MASK) {

// allow scrolling

return FALSE;

}

if ( ( mevent.state & GDK_BUTTON1_MASK ) && !pc->grab && pc->is_drawing) {

/* Grab mouse, so release will not pass unnoticed */

pc->grab = SP_CANVAS_ITEM(dt->acetate);

sp_canvas_item_grab(pc->grab, ( GDK_KEY_PRESS_MASK | GDK_BUTTON_PRESS_MASK |

GDK_BUTTON_RELEASE_MASK |

GDK_POINTER_MOTION_MASK ),

NULL, mevent.time);

}

/* Find desktop coordinates */

Geom::Point p = dt->w2d(Geom::Point(mevent.x, mevent.y));

/* Test whether we hit any anchor. */

SPDrawAnchor *anchor = spdc_test_inside(pc, Geom::Point(mevent.x, mevent.y));

if (pencil_within_tolerance) {

Inkscape::Preferences *prefs = Inkscape::Preferences::get();

gint const tolerance = prefs->getIntLimited("/options/dragtolerance/value", 0, 0, 100);

if ( Geom::LInfty( Geom::Point(mevent.x,mevent.y) - pencil_drag_origin_w ) < tolerance ) {

return FALSE; // Do not drag if we're within tolerance from origin.

}

}

// Once the user has moved farther than tolerance from the original location

// (indicating they intend to move the object, not click), then always process the

// motion notify coordinates as given (no snapping back to origin)

pencil_within_tolerance = false;

switch (pc->state) {

case SP_PENCIL_CONTEXT_ADDLINE:

/* Set red endpoint */

if (anchor) {

p = anchor->dp;

} else {

Geom::Point ptnr(p);

spdc_endpoint_snap(pc, ptnr, mevent.state);

p = ptnr;

}

spdc_set_endpoint(pc, p);

ret = TRUE;

break;

default:

/* We may be idle or already freehand */

if ( mevent.state & GDK_BUTTON1_MASK && pc->is_drawing ) {

if (pc->state == SP_PENCIL_CONTEXT_IDLE) {

sp_event_context_discard_delayed_snap_event(event_context);

}

pc->state = SP_PENCIL_CONTEXT_FREEHAND;

if ( !pc->sa && !pc->green_anchor ) {

/* Create green anchor */

pc->green_anchor = sp_draw_anchor_new(pc, pc->green_curve, TRUE, pc->p[0]);

}

if (anchor) {

p = anchor->dp;

}

if ( pc->npoints != 0) { // buttonpress may have happened before we entered draw context!

if (pc->ps.empty()) {

// Only in freehand mode we have to add the first point also to pc->ps (apparently)

// - We cannot add this point in spdc_set_startpoint, because we only need it for freehand

// - We cannot do this in the button press handler because at that point we don't know yet

// wheter we're going into freehand mode or not

pc->ps.push_back(pc->p[0]);

}

spdc_add_freehand_point(pc, p, mevent.state);

ret = TRUE;

}

if (anchor && !pc->anchor_statusbar) {

pc->_message_context->set(Inkscape::NORMAL_MESSAGE, _("<b>Release</b> here to close and finish the path."));

pc->anchor_statusbar = true;

} else if (!anchor && pc->anchor_statusbar) {

pc->_message_context->clear();

pc->anchor_statusbar = false;

} else if (!anchor) {

pc->_message_context->set(Inkscape::NORMAL_MESSAGE, _("Drawing a freehand path"));

}

} else {

if (anchor && !pc->anchor_statusbar) {

pc->_message_context->set(Inkscape::NORMAL_MESSAGE, _("<b>Drag</b> to continue the path from this point."));

pc->anchor_statusbar = true;

} else if (!anchor && pc->anchor_statusbar) {

pc->_message_context->clear();

pc->anchor_statusbar = false;

}

}

// Show the pre-snap indicator to communicate to the user where we would snap to if he/she were to

// a) press the mousebutton to start a freehand drawing, or

// b) release the mousebutton to finish a freehand drawing

if (!sp_event_context_knot_mouseover(pc)) {

SnapManager &m = dt->namedview->snap_manager;

m.setup(dt);

m.preSnap(Inkscape::SnapCandidatePoint(p, Inkscape::SNAPSOURCE_NODE_HANDLE));

m.unSetup();

}

break;

}

return ret;

}

static gint

pencil_handle_button_release(SPPencilContext *const pc, GdkEventButton const &revent)

{

gint ret = FALSE;

SPEventContext *event_context = SP_EVENT_CONTEXT(pc);

if ( revent.button == 1 && pc->is_drawing && !event_context->space_panning) {

SPDesktop *const dt = pc->desktop;

pc->is_drawing = false;

/* Find desktop coordinates */

Geom::Point p = dt->w2d(Geom::Point(revent.x, revent.y));

/* Test whether we hit any anchor. */

SPDrawAnchor *anchor = spdc_test_inside(pc, Geom::Point(revent.x,

revent.y));

switch (pc->state) {

case SP_PENCIL_CONTEXT_IDLE:

/* Releasing button in idle mode means single click */

/* We have already set up start point/anchor in button_press */

if (!(revent.state & GDK_CONTROL_MASK)) {

// Ctrl+click creates a single point so only set context in ADDLINE mode when Ctrl isn't pressed

pc->state = SP_PENCIL_CONTEXT_ADDLINE;

}

ret = TRUE;

break;

case SP_PENCIL_CONTEXT_ADDLINE:

/* Finish segment now */

if (anchor) {

p = anchor->dp;

} else {

spdc_endpoint_snap(pc, p, revent.state);

}

pc->ea = anchor;

spdc_set_endpoint(pc, p);

spdc_finish_endpoint(pc);

pc->state = SP_PENCIL_CONTEXT_IDLE;

sp_event_context_discard_delayed_snap_event(event_context);

ret = TRUE;

break;

case SP_PENCIL_CONTEXT_FREEHAND:

if (revent.state & GDK_MOD1_MASK) {

/* sketch mode: interpolate the sketched path and improve the current output path with the new interpolation. don't finish sketch */

sketch_interpolate(pc);

if (pc->green_anchor) {

pc->green_anchor = sp_draw_anchor_destroy(pc->green_anchor);

}

pc->state = SP_PENCIL_CONTEXT_SKETCH;

} else {

/* Finish segment now */

/// \todo fixme: Clean up what follows (Lauris)

if (anchor) {

p = anchor->dp;

} else {

Geom::Point p_end = p;

spdc_endpoint_snap(pc, p_end, revent.state);

if (p_end != p) {

// then we must have snapped!

spdc_add_freehand_point(pc, p_end, revent.state);

}

}

pc->ea = anchor;

/* Write curves to object */

dt->messageStack()->flash(Inkscape::NORMAL_MESSAGE, _("Finishing freehand"));

interpolate(pc);

spdc_concat_colors_and_flush(pc, FALSE);

pc->sa = NULL;

pc->ea = NULL;

if (pc->green_anchor) {

pc->green_anchor = sp_draw_anchor_destroy(pc->green_anchor);

}

pc->state = SP_PENCIL_CONTEXT_IDLE;

// reset sketch mode too

pc->sketch_n = 0;

}

ret = TRUE;

break;

case SP_PENCIL_CONTEXT_SKETCH:

default:

break;

}

if (pc->grab) {

/* Release grab now */

sp_canvas_item_ungrab(pc->grab, revent.time);

pc->grab = NULL;

}

ret = TRUE;

}

return ret;

}

static void

pencil_cancel (SPPencilContext *const pc)

{

if (pc->grab) {

/* Release grab now */

sp_canvas_item_ungrab(pc->grab, 0);

pc->grab = NULL;

}

pc->is_drawing = false;

pc->state = SP_PENCIL_CONTEXT_IDLE;

sp_event_context_discard_delayed_snap_event(SP_EVENT_CONTEXT(pc));

pc->red_curve->reset();

sp_canvas_bpath_set_bpath(SP_CANVAS_BPATH(pc->red_bpath), NULL);

while (pc->green_bpaths) {

sp_canvas_item_destroy(SP_CANVAS_ITEM(pc->green_bpaths->data));

pc->green_bpaths = g_slist_remove(pc->green_bpaths, pc->green_bpaths->data);

}

pc->green_curve->reset();

if (pc->green_anchor) {

pc->green_anchor = sp_draw_anchor_destroy(pc->green_anchor);

}

pc->_message_context->clear();

pc->_message_context->flash(Inkscape::NORMAL_MESSAGE, _("Drawing cancelled"));

pc->desktop->canvas->endForcedFullRedraws();

}

static gint

pencil_handle_key_press(SPPencilContext *const pc, guint const keyval, guint const state)

{

gint ret = FALSE;

switch (keyval) {

case GDK_KEY_Up:

case GDK_KEY_Down:

case GDK_KEY_KP_Up:

case GDK_KEY_KP_Down:

// Prevent the zoom field from activation.

if (!mod_ctrl_only(state)) {

ret = TRUE;

}

break;

case GDK_KEY_Escape:

if (pc->npoints != 0) {

// if drawing, cancel, otherwise pass it up for deselecting

if (pc->state != SP_PENCIL_CONTEXT_IDLE) {

pencil_cancel (pc);

ret = TRUE;

}

}

break;

case GDK_KEY_z:

case GDK_KEY_Z:

if (mod_ctrl_only(state) && pc->npoints != 0) {

// if drawing, cancel, otherwise pass it up for undo

if (pc->state != SP_PENCIL_CONTEXT_IDLE) {

pencil_cancel (pc);

ret = TRUE;

}

}

break;

case GDK_KEY_g:

case GDK_KEY_G:

if (mod_shift_only(state)) {

sp_selection_to_guides(SP_EVENT_CONTEXT(pc)->desktop);

ret = true;

}

break;

case GDK_KEY_Alt_L:

case GDK_KEY_Alt_R:

case GDK_KEY_Meta_L:

case GDK_KEY_Meta_R:

if (pc->state == SP_PENCIL_CONTEXT_IDLE) {

pc->desktop->messageStack()->flash(Inkscape::NORMAL_MESSAGE, _("<b>Sketch mode</b>: holding <b>Alt</b> interpolates between sketched paths. Release <b>Alt</b> to finalize."));

}

break;

default:

break;

}

return ret;

}

static gint

pencil_handle_key_release(SPPencilContext *const pc, guint const keyval, guint const /*state*/)

{

gint ret = FALSE;

switch (keyval) {

case GDK_KEY_Alt_L:

case GDK_KEY_Alt_R:

case GDK_KEY_Meta_L:

case GDK_KEY_Meta_R:

if (pc->state == SP_PENCIL_CONTEXT_SKETCH) {

spdc_concat_colors_and_flush(pc, FALSE);

pc->sketch_n = 0;

pc->sa = NULL;

pc->ea = NULL;

if (pc->green_anchor) {

pc->green_anchor = sp_draw_anchor_destroy(pc->green_anchor);

}

pc->state = SP_PENCIL_CONTEXT_IDLE;

sp_event_context_discard_delayed_snap_event(SP_EVENT_CONTEXT(pc));

pc->desktop->messageStack()->flash(Inkscape::NORMAL_MESSAGE, _("Finishing freehand sketch"));

ret = TRUE;

}

break;

default:

break;

}

return ret;

}

static void

spdc_set_startpoint(SPPencilContext *const pc, Geom::Point const &p)

{

pc->npoints = 0;

pc->red_curve_is_valid = false;

if (in_svg_plane(p)) {

pc->p[pc->npoints++] = p;

}

}

static void

spdc_set_endpoint(SPPencilContext *const pc, Geom::Point const &p)

{

if (pc->npoints == 0) {

return;

/* May occur if first point wasn't in SVG plane (e.g. weird w2d transform, perhaps from bad

}

g_return_if_fail( pc->npoints > 0 );

pc->red_curve->reset();

if ( ( p == pc->p[0] )

|| !in_svg_plane(p) )

{

pc->npoints = 1;

} else {

pc->p[1] = p;

pc->npoints = 2;

pc->red_curve->moveto(pc->p[0]);

pc->red_curve->lineto(pc->p[1]);

pc->red_curve_is_valid = true;

sp_canvas_bpath_set_bpath(SP_CANVAS_BPATH(pc->red_bpath), pc->red_curve);

}

}

static void

spdc_finish_endpoint(SPPencilContext *const pc)

{

if ( ( pc->red_curve->is_empty() )

|| ( *(pc->red_curve->first_point()) == *(pc->red_curve->second_point()) ) )

{

pc->red_curve->reset();

sp_canvas_bpath_set_bpath(SP_CANVAS_BPATH(pc->red_bpath), NULL);

} else {

/* Write curves to object. */

spdc_concat_colors_and_flush(pc, FALSE);

pc->sa = NULL;

pc->ea = NULL;

}

}

static void

spdc_add_freehand_point(SPPencilContext *pc, Geom::Point const &p, guint /*state*/)

{

g_assert( pc->npoints > 0 );

g_return_if_fail(unsigned(pc->npoints) < G_N_ELEMENTS(pc->p));

if ( ( p != pc->p[ pc->npoints - 1 ] )

&& in_svg_plane(p) )

{

pc->ps.push_back(p);

pc->p[pc->npoints++] = p;

fit_and_split(pc);

}

}

static inline double

square(double const x)

{

return x * x;

}

static void

interpolate(SPPencilContext *pc)

{

if ( pc->ps.size() <= 1 ) {

return;

}

Inkscape::Preferences *prefs = Inkscape::Preferences::get();

double const tol = prefs->getDoubleLimited("/tools/freehand/pencil/tolerance", 10.0, 1.0, 100.0) * 0.4;

double const tolerance_sq = 0.02 * square( pc->desktop->w2d().descrim() *

tol) * exp(0.2*tol - 2);

g_assert(is_zero(pc->req_tangent)

|| is_unit_vector(pc->req_tangent));

Geom::Point const tHatEnd(0, 0);

guint n_points = pc->ps.size();

pc->green_curve->reset();

pc->red_curve->reset();

pc->red_curve_is_valid = false;

Geom::Point * b = g_new(Geom::Point, 4*n_points);

Geom::Point * points = g_new(Geom::Point, 4*n_points);

for (unsigned int i = 0; i < pc->ps.size(); i++) {

points[i] = pc->ps[i];

}

// worst case gives us a segment per point

int max_segs = 4*n_points;

int const n_segs = Geom::bezier_fit_cubic_r(b, points, n_points,

tolerance_sq, max_segs);

if ( n_segs > 0)

{

/* Fit and draw and reset state */

pc->green_curve->moveto(b[0]);

for (int c = 0; c < n_segs; c++) {

pc->green_curve->curveto(b[4*c+1], b[4*c+2], b[4*c+3]);

}

sp_canvas_bpath_set_bpath(SP_CANVAS_BPATH(pc->red_bpath), pc->green_curve);

/* Fit and draw and copy last point */

g_assert(!pc->green_curve->is_empty());

/* Set up direction of next curve. */

{

Geom::Curve const * last_seg = pc->green_curve->last_segment();

g_assert( last_seg ); // Relevance: validity of (*last_seg)

pc->p[0] = last_seg->finalPoint();

pc->npoints = 1;

Geom::Curve *last_seg_reverse = last_seg->reverse();

Geom::Point const req_vec( -last_seg_reverse->unitTangentAt(0) );

delete last_seg_reverse;

pc->req_tangent = ( ( Geom::is_zero(req_vec) || !in_svg_plane(req_vec) )

? Geom::Point(0, 0)

: Geom::unit_vector(req_vec) );

}

}

g_free(b);

g_free(points);

pc->ps.clear();

}

static void

sketch_interpolate(SPPencilContext *pc)

{

if ( pc->ps.size() <= 1 ) {

return;

}

Inkscape::Preferences *prefs = Inkscape::Preferences::get();

double const tol = prefs->getDoubleLimited("/tools/freehand/pencil/tolerance", 10.0, 1.0, 100.0) * 0.4;

double const tolerance_sq = 0.02 * square( pc->desktop->w2d().descrim() *

tol) * exp(0.2*tol - 2);

bool average_all_sketches = prefs->getBool("/tools/freehand/pencil/average_all_sketches", true);

g_assert(is_zero(pc->req_tangent)

|| is_unit_vector(pc->req_tangent));

Geom::Point const tHatEnd(0, 0);

guint n_points = pc->ps.size();

pc->red_curve->reset();

pc->red_curve_is_valid = false;

Geom::Point * b = g_new(Geom::Point, 4*n_points);

Geom::Point * points = g_new(Geom::Point, 4*n_points);

for (unsigned i = 0; i < pc->ps.size(); i++) {

points[i] = pc->ps[i];

}

// worst case gives us a segment per point

int max_segs = 4*n_points;

int const n_segs = Geom::bezier_fit_cubic_r(b, points, n_points,

tolerance_sq, max_segs);

if ( n_segs > 0)

{

Geom::Path fit(b[0]);

for (int c = 0; c < n_segs; c++) {

fit.appendNew<Geom::CubicBezier>(b[4*c+1], b[4*c+2], b[4*c+3]);

}

Geom::Piecewise<Geom::D2<Geom::SBasis> > fit_pwd2 = fit.toPwSb();

if ( pc->sketch_n > 0 ) {

double t =0.;

if (average_all_sketches) {

// Average = (sum of all) / n

// = (sum of all + new one) / n+1

// = ((old average)*n + new one) / n+1

t = pc->sketch_n / (pc->sketch_n + 1.);

} else {

t = 0.5;

}

pc->sketch_interpolation = Geom::lerp(t, fit_pwd2, pc->sketch_interpolation);

// simplify path, to eliminate small segments

Path *path = new Path;

path->LoadPathVector(Geom::path_from_piecewise(pc->sketch_interpolation, 0.01));

path->Simplify(0.5);

Geom::PathVector *pathv = path->MakePathVector();

pc->sketch_interpolation = (*pathv)[0].toPwSb();

delete path;

delete pathv;

} else {

pc->sketch_interpolation = fit_pwd2;

}

pc->sketch_n++;

pc->green_curve->reset();

pc->green_curve->set_pathvector(Geom::path_from_piecewise(pc->sketch_interpolation, 0.01));

sp_canvas_bpath_set_bpath(SP_CANVAS_BPATH(pc->red_bpath), pc->green_curve);

/* Fit and draw and copy last point */

g_assert(!pc->green_curve->is_empty());

/* Set up direction of next curve. */

{

Geom::Curve const * last_seg = pc->green_curve->last_segment();

g_assert( last_seg ); // Relevance: validity of (*last_seg)

pc->p[0] = last_seg->finalPoint();

pc->npoints = 1;

Geom::Curve *last_seg_reverse = last_seg->reverse();

Geom::Point const req_vec( -last_seg_reverse->unitTangentAt(0) );

delete last_seg_reverse;

pc->req_tangent = ( ( Geom::is_zero(req_vec) || !in_svg_plane(req_vec) )

? Geom::Point(0, 0)

: Geom::unit_vector(req_vec) );

}

}

g_free(b);

g_free(points);

pc->ps.clear();

}

static void

fit_and_split(SPPencilContext *pc)

{

g_assert( pc->npoints > 1 );

double const tolerance_sq = 0;

Geom::Point b[4];

g_assert(is_zero(pc->req_tangent)

|| is_unit_vector(pc->req_tangent));

Geom::Point const tHatEnd(0, 0);

int const n_segs = Geom::bezier_fit_cubic_full(b, NULL, pc->p, pc->npoints,

pc->req_tangent, tHatEnd,

tolerance_sq, 1);

if ( n_segs > 0

&& unsigned(pc->npoints) < G_N_ELEMENTS(pc->p) )

{

/* Fit and draw and reset state */

pc->red_curve->reset();

pc->red_curve->moveto(b[0]);

pc->red_curve->curveto(b[1], b[2], b[3]);

sp_canvas_bpath_set_bpath(SP_CANVAS_BPATH(pc->red_bpath), pc->red_curve);

pc->red_curve_is_valid = true;

} else {

/* Fit and draw and copy last point */

g_assert(!pc->red_curve->is_empty());

/* Set up direction of next curve. */

{

Geom::Curve const * last_seg = pc->red_curve->last_segment();

g_assert( last_seg ); // Relevance: validity of (*last_seg)

pc->p[0] = last_seg->finalPoint();

pc->npoints = 1;

Geom::Curve *last_seg_reverse = last_seg->reverse();

Geom::Point const req_vec( -last_seg_reverse->unitTangentAt(0) );

delete last_seg_reverse;

pc->req_tangent = ( ( Geom::is_zero(req_vec) || !in_svg_plane(req_vec) )

? Geom::Point(0, 0)

: Geom::unit_vector(req_vec) );

}

pc->green_curve->append_continuous(pc->red_curve, 0.0625);

SPCurve *curve = pc->red_curve->copy();

/// \todo fixme:

SPCanvasItem *cshape = sp_canvas_bpath_new(sp_desktop_sketch(pc->desktop), curve);

curve->unref();

sp_canvas_bpath_set_stroke(SP_CANVAS_BPATH(cshape), pc->green_color, 1.0, SP_STROKE_LINEJOIN_MITER, SP_STROKE_LINECAP_BUTT);

pc->green_bpaths = g_slist_prepend(pc->green_bpaths, cshape);

pc->red_curve_is_valid = false;

}

}